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ABSTRACT 


A  Multi  variable  Control  System  is  designed  for  a  deeply 
submerged  submarine  using  the  Linear  Quadratic  Gaussian 
(LQ6)  with  Loop  Transfer  Recovery  (LTR)  methodology.  The 
differential  stern,  bow,  and  rudder  control  surfaces  are 
dynamically  coordinated  to  cause  the  submarine  to  follow 
independent  and  simultaneous  commanded  changes  in  roll,  yaw 
rate,  depth  rate  and  pitch  attitude.  Linear  models  of  the 
submarine  are  developed  at  a  ship  speed  of  30  knots  with 
various  rudder  angles  and  then  qgalyzed  using  the  method  of 
modal  analysis.  The  linear  models  are  then  augmented  with 
integral  control,  loop  shaping  techniques  are  applied  to 
design  a  Kalman  Filter  transfer  function,  and  the  LTR 
technique  is  applied  to  recover  the  Kalman  Filter  loop 
shapes.  The  resulting  model-based  compensator  and  plant  is 
tested  using  a  non-linear  mathematical  model  of  the 
submarine,  and  comparisons  are  made  with  an  equivalent 
compensator  design  that  lacks  active  roll  control 
capability.  The  performance  character i sties  of  the  closed 
loop  design  with  roll  control  capability  was  significantly 
better  than  the  characteri sties  of  the  design  without  roll 
control  _ _ 
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CHAPTER  ONE 


INTRODUCTION  AND  SUMMARY 

1.1  Background 

The  advent  of  the  microprocessor  is  having  a 
significant  effect  on  ship  control,  as  it  is  in  many  other 
fields  of  engineering.  In  particular,  the  present 
technology  for  the  design  and  implementation  of  digitally 
based  multi  variable  control  systems  has  improved 
drastically,  resulting  in  a  very  strong  need  for  the 
analysis  of  complex,  long  standing  design  problems. 

As  it  stands  today,  multi-input,  multi-output  (MIMO) 
control  system  design  is  much  more  difficult  than  either 
classical  control  system  design  or  single  input,  single 
output  (SISO)  control  system  design.  This  MIMO  methodology, 
and  in  particular  the  LQG/LTR  method,  also  appears  to  be 
relatively  unknown  to  many  researchers  and  engineers 
involved  with  control  systems  design.  (This  observation  was 
extremely  apparent  at  the  Seventh  Ship  Control  Systems 
Symposium  in  Bath,  UK  in  September  1984).  It  appears  that 
the  major  reason  the  LQG/LTR  methodology  is  as  yet  unknown 
is  because  of  its  recent  development,  and  limited 
application  to  actual  engineering  design  problems.  Another 
reason,  although  less  significant  than  the  first,  is  that  a 
significant  amount  of  effort  is  required  to  develop  a 
realistic  model  of  the  system  being  considered,  to  design 
the  controller,  and  then  to  evaluate  the  design. 


It  is  therefore  instructive  to  apply  the  MIMQ 


methodology  to  realistic  ship  examples  to  display  the  power 
and  benefits  of  the  methodology,  to  understand  possible 
shortcomings  with  the  procedures,  and  to  provide  results  of 
model  tests  (in  this  case  a  computer  program  simulation  of  a 
full  scale  submarine).  See  Appendix  A  for  a  description  of 
key  issues  in  submarine  control. 

1.2  Prior  Work 

The  majority  of  previous  controller  designs  for 
submarines  have  used  the  SISO  design  methodology  or 
classical  design  techniques.  There  have  been  a  limited 
number  of  examples  of  MIMO  designs  for  full  scale 
submarines.  These  were  performed  by  Navy  graduate  students 
at  MIT  under  the  supervision  of  Professors  Lena  Valavani  and 
Michael  Athans  CIO  through  133. 

In  previous  designs,  the  use  of  pitch,  roll,  and  depth 
control  were  not  fully  utilized.  The  vertical  velocity  (w) 
was  generally  used  to  represent  one  of  the  state  variables 
considered.  Since  w(t)  is  not  an  inertial  reference 
variable,  it  represents  the  true  vertical  rate  only  when  the 
submarine  has  zero  pitch  and  roll  angles. 

Although  the  depth  rate,  z<t),  is  not  directly 
available  as  a  state  variable,  it  can  be  easily  constructed 
from  the  geometric  relation  that 

z(t)  =  -u  si nO  +  v  cosOsin*  +  w  cosOcos* 
which  consists  of  terms  that  are  readily  available. 


Additionally,  active  roll  control  -for  a  cruci-form  stern 


has,  not  been  used  in  previous  theses.  Active  roll  control 
is  used  in  this  thesis  to  demonstrate  its  advantages. 

1.5  Contributions  of  the  Thesis 

The  major  contribution  o-f  this  thesis  is  to  demonstrate 
the  multivariable  LQG/LTR  -feedback  control  system  design 
methodology  -for  a  submarine.  Me  demonstrate  how  to  design 
using  the  LQG/LTR  methodology  a  -four  input,  -four  output  MIMQ 
-feedback  control  system  in  which  the  di -f -f erenti al  stern, 
bow,  and  rudder  control  surfaces  are  used  to  cause  the 
submarine  to  -follow  independent  and  simultaneous  commands  in 
roll,  yaw  rate,  pitch,  and  depth  rate.  A  second 
contribution  o-f  this  thesis  is  to  demonstrate  the 
improvement  in  operational  capabilities  o-f  -full  scale 
submarines  if  active  roll  control  is  employed.  The  closed 
loop  dynamic  response  of  the  submarine  is  improved 
considerably  over  a  submarine  without  active  roll  control  - 
In  either  case,  the  LQG/LTR  design  methodology  was  found  to 
be  robust  when  evaluated  in  non-linear  simulations,  even 
though  there  were  significant  changes  between  the  dynamic 
characteri sties  of  the  linear  and  non-linear  models. 

1.4  Outline  of  the  Thesis 

Chapter  2  contains  a  physical  description  of  the 
submarine  and  the  development  of  the  model  employed  in  this 
thesis.  A  brief  description  of  the  model  implementation  at 
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Draper's  computer  -facility  is  also  discussed.  The  latter 
part  o-f  the  chapter  describes  the  process  used  to  linearize 
the  submarine  model,  and  a  discussion  o-f  the  reasoning  used 
to  select  the  output  and  control  variables. 

Chapter  3  contains  the  analysis  o-f  the  linear  model 
eigenstructure  using  modal  decomposition.  The  structure  o-f 
the  pole-zero  composition  and  singular  values  are  also 
utilized  to  display  the  open  loop  dynamics  o-f  the  model. 

Chapter  4  contains  a  discussion  o-f  the  LQG/LTR 
methodology.  The  performance  specif i cations  of  the 
controller  are  discussed,  and  the  linear  portion  of  the 
control  system  design  is  presented. 

Chapter  5  contains  the  evaluation  of  the  compensator 
using  both  the  linear  and  non-linear  submarine  simulations. 
Comparisons  are  also  provided  with  a  compensator  which  does 
not  have  the  capability  of  active  roll  control,  but  which  is 
otherwise  designed  to  the  same  specifications. 

Chapter  6  contains  the  summary,  and  proposals  for 


future  research. 


CHAPTER  TWO 


THE  SUBMARINE  MODEL 

2.1  Introduction 

The  non-linear  submarine  dynamical  model  used  in  this 
thesis  is  implemented  at  Draper  Laboratory  both  as  a  real¬ 
time  simulation  -facility  and  as  an  analytical  model 
generating  -facility.  A  summary  o-f  the  SUBMODEL  program  can 
be  -found  in  Appendix  B.  A  detailed  discussion  can  be  -found 
in  reference  C141. 

The  rudder  and  stern  plane  con-f i gurati on  to  be 
investigated  is  the  so-called  cruciform  stern.  Existing 
submarines  use  a  cruciform  stern  with  mechanically  coupled 
upper  and  lower  rudders,  and  mechanically  coupled  port  and 
starboard  stern  planes.  The  advantage  of  this  stern 
configuration  is  that  the  design  allows  intuitive  actions  by 
the  operator  for  desired  ship  motion.  For  example,  if  it  is 
desired  to  rise  or  dive,  all  the  operator  has  to  do  is 
command  rise  or  dive  on  the  stern  planes.  A  similar 
situation  exists  if  the  operator  desires  to  turn.  A  major 
drawback  to  this  stern  however,  is  that  there  is  no 
opportunity  to  actively  control  roll  on  existing  submarines. 
A  submarine  has  the  natural  tendency  to  roll  in  a  turn,  and 
since  the  snap  roll  of  a  submarine  in  a  turn  is  a  function 
of  the  speed  into  the  turn  and  the  initial  displaced  rudder 
angle,  it  becomes  very  difficult  for  the  operator  to  - 
maintain  a  level  trajectory,  and  even  more  difficult  to 


command  at  the  same  time  a  desired  pitch  and/or  depth  rate 


change. 

This  thesis  will  investigate  the  utilization  of  active 
roll  control,  and  implementation  o-f  a  control  surface 
feedback  control  scheme  that  will  consider  the  mobility 
characteri sties  of  depth,  course,  and  speed  (in  that  order). 
This  investigation  will  be  performed  using  the  LQG/LTR 
methodology  for  the  control  system  design. 

Experience  with  full  scale  submarines  has  shown  that 
roll  plays  a  significant  factor  in  the  ability  of  the 
operator  to  maintain  ordered  depth  in  turns  or  rudder 
malfunctions.  This  experience  has  also  been  shown  in 
computer  models  of  submarines,  including  the  SUBSIM  model  at 
Draper  laboratory.  If  methods  are  utilized  to  reduce  the 
snap  roll,  the  ability  to  maintain  ordered  depth  is  greatly 
increased. 

This  chapter  discusses  the  development,  implementation, 
and  1 inearization  of  the  submarine  model  upon  which  the 
remainder  of  this  thesis  is  based.  The  reasoning  used  to 
select  the  output  and  control  variables  is  also  presented. 

2.2  Model  Development 

Submarine  hydrodynamics  is  primarily  concerned  with  the 
motion  of  a  body  through  the  water.  Consequently,  there 
must  be  a  means  of  defining  the  body  orientation  with 
respect  to  the  fluid  flow,  and  the  location  of  the  body  with 
respect  to  some  fixed  reference  frame. 


In  de-fining  the  motion  o-f  a  submarine,  reference  must 


be  made  to  two  sets  of  coordinate  axes;  one  fixed  in  the 
ship  and  one  fixed  with  respect  to  the  earth. 

2.2.1  Ship  Coordinates 

The  axes  fixed  in  the  ship  (x,y,  and  z>  are  in  a  right- 
handed  orthogonal  system  where  the  origin  is  taken  to  be  the 
mass  center  of  the  ship.  The  mass  center  is  assumed  to  lie 
in  the  vertical  centerplane  of  the  ship  and  is  usually  a 
short  distance  below  the  longitudinal  axis  of  symmetry.  The 
mass  center  is  assumed  not  to  move  during  ship  maneuvers. 

The  center  of  the  coordinate  system  is  at  the  center  of  mass 
for  motion  along  any  of  the  three  orthogonal  axes. 
Additionally,  the  moments  of  inertia,  including  the  inertia 
due  to  the  water,  are  taken  around  the  three  orthogonal  axes 
and  are  designated  K,  M,  and  N. 

2.2.2  Fixed  Coordinates 

The  second  set  of  axes  (X,  Y,  and  Z)  required  to 
define  the  motion  of  the  submarine  is  one  which  is  fixed 
with  respect  to  the  earth.  Like  the  ship  axes,  these 
coordinates  form  a  right-handed  orthogonal  system. 

Figure  2.1  shows  the  reference  system  used  in  this 
thesis. 


Figure  2.1  Sketch  showing  positive  directions  of  axes, 
angles,  velocities,  forces,  and  moments. 

2.5  Definitions  of  Submarine  States  and  Control  Variables 

In  general,  for  the  purposes  of  modelling  the  dynamics 
of  submarine  motion,  the  equations  of  motion  are  expressed 
in  the  ship  coordinate  system  because  hydrodynamic  forces 
and  moments  are  readily  computed  in  this  reference  frame. 

On  the  other  hand,  when  interested  in  guidance  and  control 
of  a  submarine,  it  may  be  desirable  to  describe  the  vehicle 
motion  in  terms  of  the  fixed  coordinate  system. 

General  equations  have  already  been  developed  for  the 
description  of  the  dynamics  of  underwater  vehicle  motion, 
these  equations  generally  contain  expressions  for  Newtonian 
forces  and  moments  on  the  left  hand  side,  and  the 


expressions  -for  dynamic  response  on  the  right  hand  side. 

The  le-ft  hand  side  o-f  the  equations  becomes  quite  involved 
due  to  the  transformations  o-f  the  coordinate  system  -from  the 
center  o-f  mass  to  the  center  o-f  buoyancy;  which  is  more 
correctly  the  reference  point  in  these  equations  because 
this  point  is  a  -function  o-f  the  submarine  geometry  and  is 
-fixed  whereas  the  center  o-f  mass  may  shift  due  to  shifting 
of  weights  within  the  submarine.  Details  of  these 
transformations  can  be  found  in  Abkowits  C163.  The  right 
hand  side  of  the  equations  represent  the  external  forces  and 
moments  exerted  on  the  submarine  by  hydrodynamic,  control 
surface,  propulsion,  and  other  effects. 

The  force  and  moment  equalities  of  the  equations  of 
motion  describe  the  six  possible  degrees  of  freedom  of 
submarine  motion.  Motions  of  surge,  heave,  and  sway  are 
represented  by  the  three  forces  in  the  axial,  lateral,  and 
normal  directions  of  motion.  Motions  of  roll,  pitch,  and 
yaw  are  represented  by  the  three  moment  equations. 

The  state  vector  for  the  submarine  must  include  the  six 
degrees  of  freedom  from 'the  ships  coordinate  system,  the 
three  Euler  angles  which  describe  the  relationship  of  the 
motion  of  the  submarine  with  respect  to  the  two  coordinate 
systems,  and  the  desired  position  variables  to  locate  the 
submarine  with  respect  to  the  fixed  coordinate  system.  As 
stated  earlier,  the  critical  effort  for  this  thesis  will  be 
to  maintain  ship's  depth  in  hard  rudder  maneuvers,  thus  2  is 
included  in  the  state  vector,  as  shown  in  Table  2.1. 


17 


Table  2.1  Definition  of  Submarine  States  and  Control 

Variables 


Submarine  States 


u 

= 

X  1  (t) 

forward  velocity 

(ft/sec) 

V 

* 

x„  (  t  ) 

lateral  velocity 

(ft/sec) 

w 

= 

x?(t) 

vertical  velocity 

(ft/sec) 

p 

= 

x4(t) 

roll  rate 

(rad/sec ) 

q 

= 

x5(t) 

pitch  rate 

(rad/sec ) 

r 

= 

x6(t) 

yaw  rate 

(rad/sec) 

♦ 

= 

x7(t) 

roll  angle 

(radians) 

e 

= 

XQ(t) 

pitch  angle 

(radians) 

V 

= 

X9(t) 

heading  angle 

(radians) 

z 

= 

Xi0(t) 

depth  (+  down) 

(feet ) 

Control  Variables 

Sb 

bow/f airwater  planes 

(rad) 

&r 

rudder  deflection 

(rad) 

&Sj  port  stern  plane  de-flection  (rad) 

&S2  starboard  stern  plane  deflection  (rad) 

Further  details  of  the  derivation  of  the  non-linear 
equations  of  motion  and  a  description  of  the  hydrodynamic 
coefficients  describing  the  submarine  geometry  and  control 
surfaces  can  be  found  in  NSRDC  Report  2510  C53. 

To  reflect  current  operating  procedures,  the  propeller 
related  thrust  control  variable  RPS  will  be  constrained  to 
turn  at  a  constant  specified  value  during  maneuvering 


si tuati ons 


2.3  Model  Implementation 

Initially,  the  computer  program  was  developed  at  the 
Naval  Ship  Research  and  Development  Center  (NSRDC) ,  and  was 
provided  to  CSDL  along  with  the  2510  Standard  Equations  of 
Motion.  These  equations  have  since  been  improved  to  include 
the  effects  of  crossflow  drag  and  vortex  contributions. 

After  approximately  one  year  of  development,  programming, 
debugging,  and  documentation,  Draper's  adapted  model  was 
implemented  in  the  simulation  laboratory,  resulting  in  a 
real  time  simulation  environment  of  the  submarine  model.  A 
Digital  Equipment  Corporation  VAX  11-780  and  graphics 
display  workstation  are  used  to  provide  visual  display  of 
the  submarine  motion  for  maneuvering  situations.  The 
capability  of  hard-copy  output  is  also  provided. 

Later,  for  the  purposes  of  analytical  control  system 
design,  the  computer  program  was  implemented  on  the  IBM 
timesharing  computer  at  CSDL.  To  aid  the  design  engineer, 
the  following  capabilities  of  the  system  are  now  included: 

1.  A  user  friendly  executive  routine  to  allow  the 
modification  of  parameters  and  selection  of 
options  for  simulation  runs.  The  routine  submits 
the  user  specified  program  for  batch  processing. 

2.  The  option  of  calculating  the  A  and  B  matrices 
that  describe  the  linearization  of  the  model  about 
a  specified  nominal  point,  in  the  form 


x<t>  -  A  x<t>  +  B  u(t). 


The  options  of  setting  control  surfaces,  as 
desired  by  the  designer,  as  a  function  of  time. 
The  options  can  be  specified  in  a  data  file, 
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calculated  using  -full  state  -feedback,  or  by 
calculation  using  a  LQG/LTR  derived  compensator. 

Hard  copy  print-outs,  plots,  or  both,  o-f  the  state 
variables  over  time  may  be  provided  o-f  either  the 
non-linear  or  the  linear  models. 

5.  The  capability  o-f  searching  -for  a  local 
equilibrium  point  for  the  non-linear  model  that  i 
close  to  the  specified  desired  nominal  point. 


It  is  important  to  note  the  following  limitations  of 
the  non-linear  model  as  it  is  currently  implemented: 


1.  Actuator  dynamics,  or  the  actual  angle  rate  limits 
of  the  control  surfaces  are  not  modelled. 

2.  Vortex  shedding  and  separation  effects  of  the 
fluid  are  not  included  in  the  linearized  model. 


2.4  Model  Linearization 

The  controller  design  procedure  begins  with  the 
expression  of  the  equations  of  motion  in  linear  time 
invariant  state  space  form.  The  non-linear,  multivariable 
system  that  represents  the  submarine  is  described  by: 

d  x  (t)  *  f  (x  (t)  ,u(t)  ) 
dt 

£<t)  a  g  (x_<t ) ) 

where: 

x.(t)  is  the  state  vector 
u(t)  is  the  control  vector 
£<t)  is  the  output  vector 

These  non-linear  equations  can  then  be  linearized  through  a 
fairly  strai ght-f orward  technique.  A  nominal  point  is 


chosen  -for  the  design  by  integrating  the  non-linear  equations 
of  motion  using  a  specified  set  of  initial  conditions.  An 
equilibrium  point  is  found  that  corresponds  to  minimum 
accelerations  for  all  the  state  variables  determined  from 
the  integration  of  the  equations  of  motion.  The  values  of 
the  state  variables  at  the  equilibrium  point  then  specify 
a  nominal  point,  about  which  higher  order  terms  may  be 
neglected.  From  these  results,  a  set  of  linear  differential 
equations  may  then  be  produced,  the  A  and  B  matrices 
calculated,  and  a  state  space  description  of  the  submarine 
model  produced. 

For  each  nominal  point  determined,  the  resulting  linear 
model  must  be  validated  by  perturbing  the  nominal  point  to 
form  a  set  of  initial  conditions,  and  then  comparing  the 
results  of  integrating  the  non-linear  and  linear  equations  of 
motion.  For  small  perturbati ons ,  the  non-linear  model  should 
always  return  to  the  equilibrium  point  values.  The  linear 
model,  however,  will  never  reach  equilibrium  due  to  the 
forces  imposed  by  the  control  surfaces.  The  comparisons  of 
the  two  models  should,  however,  provide  a  means  to  compare 
initial  derivatives,  natural  frequencies,  and  the  damping 
effects. 

The  nominal  point  chosen  for  the  design  corresponds  to 
a  level  submarine  trajectory  at  30  knots.  The  rudder 
deflection,  &r,  can  be  set  at  arbitrary  angles  to  cause  the 
submarine  to  turn  at  different  rates,  and  to  roll  at 
different  angles.  This  attempts  to  determine  the  open  loop 


sensitivity  of  the  submarine  to  roll,  which  has  a 


significant  effect  on  the  depth  of  a  submarine  in  a  turning 
maneuver . 

Linear  models  were  developed  for  rudder  deflections 
from  0°  to  25°.  The  models  are  designated  S30R0,  S30R1, 
S30R5,  etc.,  reflecting  the  speed  and  rudder  deflection. 

To  adequately  validate  the  linear  models,  it  is 
necessary  to  perturb  the  nominal  point  of  the  linear  and 
non-linear  models,  and  compare  the  time  histories  of  the 
state  parameters.  Provided  the  perturbati ons  are  not 
excessive,  the  non-linear  model  will  return  to  the 
equilibrium  point.  The  linear  model,  however,  will  not 
return  to  it's  equilibrium  point  resulting  from  the  non-zero 
farces  imposed  by  the  control  forces,  and  the  absence  of 
non-linear  hydrodynamic  effects. 

Perturbati ons  were  applied  to  the  models  differently. 
For  the  S30R0  model,  the  perturbati ons  were  as  listed  below. 


state  variable 

u 

v 

w 

P 

q 

r 

♦ 

e 

'V 


perturbati on 

5  ft /sec 
0.5  ft/sec 
0.5  ft /sec 
-0.005  deg/sec 
+0.001  deg /sec 
-0.005  deg/sec 
-2.0  deg 
-4.6  deg 
0.0  deg 


The  remaining  models  were  perturbed  107£  above  the  nominal 
values  obtained  from  the  intergration  of  the  non-linear 
dynamics.  Remember,  these  perturbati ons  were  not  selected 


analytically,  but  were  arbitrarily  selected  to  validate  the 
linear  models. 

The  comparisons  o-f  selected  non-linear  and  linear  models 
and  state  variables  show  excellent  correlation,  thus,  serve 
to  validate  the  linearized  models.  Figures  2.2  and  2.3  show 
the  initial  derivatives,  natural  -frequency  response,  and 
damping  factors  are  almost  identical.  Similar  results  were 
obtained  for  the  other  models. 


2.5  Output  and  Control  Variable  Selections 

2.5.1  Constraints  of  the  Methodology 

Selection  of  the  output  variables  requires  a  careful 
study  of  the  A  and  B  matrices  and  determination  of  the 
objectives  of  the  controller  design.  Four  control  variables 
exist  if  RF’S  is  fixed,  and  differential  stern  planes  are 
util i zed . 

The  Loop  Transfer  Recovery  method  for  the  class  of 
Model  Based  Compensators  places  a  natural  constraint  on  the 
design  process  at  an  early  stage.  Common  sense  mathematics 
of  the  singular  values  requires  the  number  of  independent 
control  inputs  to  equal  the  number  of  independent  output 
controlled  variables.  In  other  words  if 

£<t)  £  Rm 

u(t)  £  Rp 


'•h-T 
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where  R  indicates  the  dimension  space  of  the  system.  Thus, 
the  requirement  is 


p  -  m 

and  with  -four  independent  control  surfaces  available 
p  =  4. 

2.S.2  Output  Variable  Selection: 

An  autopilot  (position  controller)  is  one  option,  where 

the  position  variables  V  and  z  are  used,  or  a  rate 

controller  could  be  designed,  where  the  rate  variables  u,  v, 

w,  p,  q,  and  r  are  used.  The  attitude  variables  8  and  •  can 

be  utilized  in  either  design,  depending  on  their  importance. 

Additionally,  a  controller  can  be  designed  which  is 

concerned  with  vertical  or  horizontal  plane  motion.  A  more 

challenging  design,  however,  is  one  which  controls  the 

dynamics  o-f  the  submarine  simultaneously  in  both  planes. 

Since  it  is  desired  to  control  the  submarine  during 

maneuvering  situations,  a  rate  controller  will  be 

investigated.  The  four  output  variables  selected  are  depth 
•  • 

rate  z,  yaw  rate  V,  roll  angle  #,  and  pitch  angle  8. 

Remember  that  depth  rate  can  be  constructed  from  the 
non-linear  expression 


z  <t> 


-u  sin8  v  cos8  sin*  +  w  cos8  cos* 


(2.4) 


and  that  yaw  rate  can  be  constructed  from  the  non-linear 
expression 

v(t)  =  (r  cos*  +  q  sin«=*)/cos6  (2.E 

Using  small  angle  approximations  we  obtain  the  expressions 
that 


<t) 


-  uS  +  w 


and 

v(t)  *  r. 

With  the  output  variables  determined,  and  the  A  and  B 
matrices  calculated,  the  state  space  description  of  the 
submarine  model  is  now  complete  and  takes  the  form 

x (t)  »  A  x <t)  +  B  u<t>  (2. 1 

y(t)  =  C  x  (t)  ,  (2.2 

where  the  output  vector  y(t)  is  given  by 

£<t>  =  C  *<t)  0<t)  V<t>  z ( t )  3T.  (2.3 

2.5.3  Control  Variable  Selection 

As  mentioned  previously,  there  are  four  possible 
control  variables  if  propeller  RF'S  is  held  constant.  These 
are  6s^,  &s_,  £r,  and  6b.  Figure  2.4  illustrates  the 


control  surface  configurations  used  in  this  thesis. 
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View  From  Stem 

Showing  Rudder  and  Differential  Stems 


Figure  2.4  Submarine  Control  Surface  Configurations 

2.6  Summary 

This  chapter  has  introduced  the  submarine  model  used 
for  this  thesis.  Additionally,  the  coordinate  systems, 
definitions  of  the  submarine  states  and  control  variables, 
and  the  process  of  developing  a  linear  model  were  briefly 
described.  Finally,  the  reasoning  for  selection  of  the 
output  variables  was  presented. 

Chapter  Three  will  analyze  the  linearized  models  using 
the  method  of  modal  decomposition.  The  ei genstructure  of 
the  linearized  models  will  also  be  presented. 


CHAPTER  THREE 


ANALYSIS  OF  THE  LINEAR  MODEL 

3.1  Introduction 

In  this  chapter,  the  structure  o-f  the  various  models 
will  be  investigated. 

In  the  previous  chapter,  a  state  space  description  o-f 
the  submarine  model  was  developed  in  the  form  of 

x<t>  =  A  x<t>  +  B  u(t) 

£<t>  =  Cx <t) . 

The  state  space  description  described  results  in  a 
tenth  order  system.  It  will  be  shown  that  the  order  of  the 
system  can  be  reduced  to  an  eighth  order  system  because  of 
the  zero  entries  in  the  A  and  B  matrices.  This  is  desirable 
only  if  these  states  are  not  utilized  in  the  control  of  the 
submarine. 

The  ei genstructure  of  the  various  models  is  analyzed 
using  the  method  of  modal  analysis  C173.  This  method  starts 
with  a  state  equation  in  a  nondiagonal  form  and  uses  matrix 
similarity  transf ormati ons  to  arrive  at  the  diagonalized 
form  of  the  A  matrix.  The  entries  of  the  diagonalized  A 
matrix  are  the  poles  of  the  open  loop  system.  The  advantage 
to  using  similarity  transformations  is  that  the  linearized 
system  is  described  in  state  space  form  as  separately 
decoupled  modes,  thus  yielding  information  as  to  the 
controllability  and  observability  of  the  system. 


This  i  nf  or  mat  i  on ,  along  with  the  pole-zero  structure, 
will  provide  the  basis  and  validity  -for  the  LQG/LTR  design 
in  the  -following  chapters. 

5.2  Reduction  o-f  the  Model 

Inspection  o-f  the  A  matrix  -for  the  linearized  model 
(Appendix  Cl)  show  that  the  present  value  of  the  states  v  and 
z  can  have  no  influence  on  any  other  state  because  the  last 
two  columns  of  the  A  matrix  contains  all  zeros.  This  means 
the  dynamic  response  of  the  submarine  is  not  affected  by 
either  the  heading  angle  or  depth  of  the  submarine.  Again, 
note  that  this  is  for  a  deeply  submerged  submarine.  For  a 
submarine  near  the  surface,  heading  and  depth  can  have  a 
significant  impact  on  the  dynamic  response  of  the  submarine 
due  to  wave  action  and  hull  suction  forces. 

Inspection  of  the  B  matrix  (Appendix  Cl)  for  the  model 
reveal  zeros  in  the  last  four  rows.  This  indicates  that  the 
control  surfaces  exert  no  direct  influence  on  the 
derivatives  of  v,  e,  •,  or  z. 

Since  the  controller  design  is  not  concerned  with  any 
of  these  states,  then  they  may  be  removed  from  the  linear 
model.  This  is  accomplished  by  deleting  the  rows  and 
columns  associated  with  those  states,  resulting  in  a  reduced 


order  system. 


3.3  Scaling 

Scaling  is  a  method  of  weighting  the  physical  units  of 
a  system  so  the  numerical  values  o-f  the  variables  make  sense 
and  become  equally  important.  Scaling  and  its  effects 
have  recently  been  discussed  by  Kappos  C20D  and  Boettcher 
C211.  Note  that  scaling  does  change  the  magnitude  of  the 
singular  values,  and  as  such,  it  impacts  the  design. 

In  this  thesis,  scaling  is  performed  in  two  distinct 
steps.  The  first  step  requires  transformations  of  the 
linearized  A,  B,  and  C  matrices  such  that  angular  components 
of  the  matrices  are  expressed  in  units  of  degrees,  feet, 
degrees/sec,  and  feet/second.  If  the  unsealed  system  is 
defined  by 


A ,  B,  C,  y,  u,  and  x, 
and  we  define  the  scaled  system  as 


A',  B',  C',  y',  u',  and  x', 


then  the  tranf ormati ons  can  be  described  by 


A' 


B ' 

C ' 


-1 


-1 


§x  A  §x 
§x  5  -u 


Sy  c  Sx  l. 


where  S  ,  S  ,  and  S  are  matrices  chosen  to  provide  the 
—x  -y  u 

desired  scaling.  Details  of  the  matrices  used  for  the 


transf ormati on  from  radians  to  degrees  can  be  found  in 
Appendix  C2. 


Now  that  the  state  space  description  o-f  the  model  is  in 


units  that  make  physical  sense,  scaling  is  required  to 
include  weighting  on  the  inputs  and  outputs.  The  weightings 
on  the  outputs  are  chosen  to  reflect  the  importance  o-f  the 
maximum  allowable  output  state  error.  It  is  assumed  that  an 
error  o-f  one  degree  in  pitch  or  roll  is  as  significant  as 
0.1  degree/sec  yaw  rate  or  0.1  ft/sec  depth  rate.  This  then 
determines  the  scaling  matrix  which  will  be  applied  at  the 
output  of  the  plant,  S^,  as 

.  1 

.  1 

1 

1 

Because  the  control  surfaces  have  physical  position 
limits,  consideration  must  be  given  to  weighting  the  inputs 
to  the  plant.  The  limitations  on  the  control  surfaces  are 
shown  below: 


control 


rate  limit 


position  limit 


&r 


7° /sec 
4° /sec 
7° /sec 


±20° 

±30° 

±25° 


Since  the  actuator  dynamics  are  above  the  anticipated 
bandwidth  of  the  compensator  and  plant,  they  will  be 
considered  as  high  frequency  modelling  errors,  and  will  be 
neglected  C 10 , 1 1 , 12 , 133 .  The  position  limits  cannot  be 
neglected  however,  because  they  are  based  on  physical 
interference  constraints,  and  on  saturation  of  the  control 


3.4  Modal  Analysis  of  the  System 

The  natural  modes  o-f  the  linearized  model  are  determined 
by  diagonalizing  the  state  space  description  o-f  the  system. 
For  a  linearized  dynamic  system  which  does  not  have  direct 
coupling  of  the  output  and  input, 

• 

x(t>  =  A  x  <t>  +  B  u  ( t )  (3.1) 

£<t>  «  C  x <t) .  (3.2) 

Performing  a  linear  transformation  from  the  state  vector 
x^(t)  to  a  new  state  vector  z^t)  by  means  of  an  as  yet 
unspecified  constant,  square,  and  invertible  matrix  T  yields 


x <t)  =  T  £(t) .  (3.3) 

Then  we  have 

I  ?.(t)  =  A  T  z  <t)  +  B  u<t)  (3.4) 

y_(t )  =  C  T  z  (t)  .  (3.5) 

Multiplying  (3.4)  by  T  * ,  we  have 

z  (t)  =  T"1  A  T  z <t)  +  T-1  B  u  (t)  (3.6) 

£<t)  =  C  T  z  <t) .  (3.7) 


If  T  is  such  that  the  resulting  T  *  A  T  matrix  is  diagonal, 
then  the  vector  z(t>  defines  a  new  state  space  in  which  the 
eigenvalues  of  the  diagonal  matrix  are  equal  to  the  diagonal 
elements.  Now,  define 

A  =  T~ 1  AT.  (3.8) 
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The  T  matrix  is  called  the  modal  matrix  because  o-f  the 
decoupling  o-f  the  modes  that  is  accomplished  when  the  state 
space  vector  is  transformed.  To  find  out  the  nature  of  the 
modal  matrix,  we  premultiply  both  sides  of  (3.8)  by  T  which 
yi el ds 

A  I  *  I  A.  (3.9 

If  we  now  designate  each  column  of  the  modal  matrix  by  v^ , 
where  i  represents  the  number  of  column  vectors,  then 
(3.9)  can  be  expressed  as 


Thus  we  see  that  the  columns  of  T  are  the  eigenvectors  of  A 
Each  column  of  the  modal  matrix  describes  the  submarine 
motion  along  the  coordinate  axes  of  the  state  vector 
components  u,  v,  w,  p,  q,  r,  *,  and  $  for  a  particular  mode 
Since  the  dynamic  response  of  the  submarine  consists  of 
linear  combinations  of  the  decoupled  modes,  analyzing  the 
columns  of  T  can  provide  useful  information  regarding  the 
dynamic  response  of  the  submarine. 

The  modal  matrix  columns  are  graphed  in  bar  chart  form 
by  taking  the  absolute  value  of  each  element  of  the 
normalized  column  vectors.  The  bar  charts  for  the 
linearized  model,  provided  in  Figure  3.2,  have  a  vertical 
scale  of  0  to  100/i  which  reflect  the  relative  magnitude  of 


the  response,  with  the  eigenvalue  of  the  mode  considered 
being  displayed  directly  beneath  the  chart. 

Additionally,  although  the  bar  charts  provide  a  convenient 
means  to  display  the  modes  o-f  the  linearized  system,  the 
physical  i nterpretati on  is  -fairly  obscure.  As  such, 
interpretation  o-f  the  modes  is  limited  to  the  fol  lowing 
observations: 

1.  All  open  loop  poles  are  in  the  le-ft  hand  plane. 

2.  Modes  1,  2,  and  3  -for  the  various  models  are 
dominated  by  the  response  of  variables  w,  •, 
and  8. 

3.  Modes  4  through  8  exhibit  reductions  in  the 
response  of  the  variables  w,  ♦,  and  8.,  with 
correspondi ng  increase  in  the  other  variables. 

4.  Modes  5  and  6  represent  an  oscillatory  mode 
dominated  by  the  roll  response. 

The  eigenvalues  and  modal  matrices  for  the  linearized  model 
are  presented  in  Appendix  01. 

To  form  a  complete  analysis,  the  specifications  for 
controllability  and  observability  will  be  discussed  in  the 
following  section. 


I 
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Analysis  for  the  Linearized  Roll  Control  Model 


Hgure  3.2(b)  Modal  Analysis  for  the  Linearized  Rolf  Control  Model 


3.5  Controllability  and  Qb«»rv*bll it 


The  eigenvalues  and  eigenvectors  that  w ere  determined 
in  the  previous  steps  will  be  studied,  and  the  conditions 
-for  controllability  and  observability  o-f  the  linearized 
systems  will  be  investigated.  This  step  is  vital  in 
establishing  the  validity  o-f  the  linearized  model. 

First,  the  linearized  system  must  have  no  unstable 
modes  which  are  not  controllable.  Second,  the  system  must 
have  no  unstable  modes  which  are  not  observable.  I-f  these 
conditions  o-f  controllability  and  observability  are 
established,  then  the  weaker  conditions  o-f  stabi  1  i zabi  1  i ty 
and  detectability  are  assured. 

The  modal  transformation  leading  to  a  diagonalized  A 
matrix  provides  a  -fairly  strai ghtf orward  technique  to 
determine  satisfaction  of  controllability  and  observability 
requirements.  Additionally,  if  the  system  does  not  meet 
those  conditions,  the  weaker  conditions  of  stabi 1 izabi 1 ity 
and  detectability  can  be  determined. 

Since  the  new  state  space  representation  of  the 
linearized  system  (3.6)  defines  a  state  space  in  which  the 
natural  modes  of  the  system  are  decoupled,  the  eigenvalues 
give  the  response  character i sties  of  the  system's  modes. 

The  eigenvectors  are  the  link  that  relate  these  response 
characteri sties  to  particular  changes  in  the  state  of  the 
system  as  measured  by  the  state  variables  ^  ,  x^,  ■  -  -  ,  x8. 
Thus,  a  particular  row  of  the  T-1  B  matrix  links  the  input 
vector  u  to  a  particular  mode  of  z_.  Each  element  in  the  row 


will  then  link  a  specific  input  to  a  mode.  Consequently,  a 
zero  entry  in  the  <i,j)  position  of  the  T~*  B  matrix  would 
indicate  the  ith  mode  cannot  be  controlled  by  the  jth  input. 

In  a  similar  manner,  the  C  T  matrix  (3.7)  indicates 
whether  a  particular  mode  is  observable  in  the  output. 

In  the  previous  section  it  was  observed  that,  for  the 
linearized  model,  the  system  response  was  dominated  by  the 
variables  w,  a,  and  6  in  the  first  two  or  three  modes.  In 
the  remaining  modes,  it  was  evident  that  all  the  state 
variables  are  affected  to  some  extent.  Questions  generally 
arise  in  Modal  Analysis  on  the  significance  of  the  responses 
when  the  physical  units  are  not  the  same.  Because  the 
scaling  in  section  3.3  accounted  for  the  differences  in 
units,  and  weightings  on  the  magnitude  of  the  system 
responses,  the  ability  to  compare  the  relative  magnitudes  of 
the  system  responses  is  valid. 

Combined  with  the  analysis  of  T  *  B,  it  is  observed  in 
Figure  3.3,  that  modes  4,7,  and  8  appear  to  be  least 
affected  by  the  control  inputs.  For  the  other  modes,  it 
appears  the  control  inputs  exhibit  strong  influence  on  the 
submarine's  response. 

It  appears  then,  that  the  modes  which  should  be 
considered  in  the  controllability  issue  are  Modes  1,2, 3, 5,  a 
6.  Referring  back  to  the  modal  response  charts  for  each 
model,  the  variables  which  show  the  most  promise  of 
controlling  are  w,  8,  p,  q,  r,  and  •. 


It  is  desirable  to  select  the  output  variables  which 


i  4.V  .'V  J  T 


can  be  referenced  in  the  inertial  reference  frame  instead  of 

the  body  reference  frame.  Based  on  this  desire,  and  the 

fact  that  it  is  also  desirable  to  control  heading  rate  in 

high  speed  maneuvers  with  a  minimum  excursion  in  depth,  this 

•  • 

analysis  shows  that  the  selection  of  z,  ♦,  6,  and  V,  are 
reasonable  output  variables. 
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Structure  of  the  Poles,  ^eros.  and  Singular  values 


In  section  3.1  it  was  observed  that  the  poles  of  the 


open  loop  plant  are  the  eigenvalues  of  the  A  matrix.  The 
models  investigated  are  all  open  loop  stable  because  they 
all  have  left  half  plane  poles. 


The  mul ti var i abl e  transmission  zeros  are  listed  in  the 
Modal  Analysis  results  in  Appendix  Dl.  The  model  presented 
is  for  a  reduced  order  state  space  system  in  which  the 

states  z  and  V  were  removed,  as  described  in  section  3.2. 

•  • 

The  output  variables,  z  and  V,  for  the  C  matrix  are  derived 
using  the  appropriate  rows  of  the  A  matrix.  If  a 
transmission  zero  is  in  the  right  half  plane,  and  if  it  is 
in  the  bandwidth  of  the  system,  it  will  impose  severe 
limitations  on  the  performance  of  the  system  [4,18,193.  If 
the  non-minimum  phase  zero  is  above  the  system  bandwidth, 
then  its  adverse  effect  should  be  greatly  attenuated.  None 
of  the  linear  models  studied  have  low  frequency  non— minimum 
phase  zeros. 

In  the  multivariable  case,  a  plot  of  the  transfer 
matrix  singular  values  is  analogous  to  the  Bode  plots  for 
Single  Input  Single  Output  (SISO)  systems  C183.  The 
singular  values  of  a  matrix  M,  «r<M)  ,  are  defined  as: 


(M)  =  C  ,\i<MHM)31/: 


where:  *  i  singular  value 

>«i  =  ith  eigenvalue  of  M 

U 

M  =  complex  conjugate  transpose  o-f  M 


the  outputs,  the  dc  gains  of  the  open  loop  transfer  function 


matrix  are  listed  in  Table  3.1  By  reading  across  -for  each 


output  variable,  the  relative  effect  of  the  control  surfaces 
can  be  determined.  The  rudder  angle  is  shown  to  strongly 
influence  the  roll  angle,  which  is  as  expected.  Pitch  angle 
is  most  affected  by  the  stern  planes,  and  the  rudder 
strongly  influences  yaw  rate.  Depth  rate  is  strongly 
influenced  by  the  stern  planes,  and  slightly  affected  by  the 
bow  planes.  The  rudder  strongly  influences  depth  rate  due 
to  the  roll  angles,  which  influence  the  depth  rate. 


Table  3.1  Input  to  Output  Coupling 
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Figure  3.5  represents  singular  value  decomposition  of 
the  linearized  model  at  dc.  The  bar  charts  represent  the 
normalized  left  and  right  singular  vectors  where 

G<s>  *  CCsI-AI_lB. 

For  s  =  0, 

G(0)  =  — CA  * B ,  where 


5  *  U£V,  and  *<t) 


Gu <t> . 


Then  y(t)  =  (JEVu(t),  and  we  can  de-fine  y'(t)  =  Eu'(t),  where 

y'(t)  ■  U_1y<t)  and  u'(t)  =  Vu<t>. 

5ii.ce  £  i  s  a  diagonal,  square  matrix,  each  element  o-f  E. 
allows  us  to  compare  the  le-ft  and  right  singular  vectors  to 
display  the  response  o-f  the  output  variables  with  respect  to 
the  input  variables. 

Referring  to  Figure  3.5(a),  for  we  observe  the 

stern  planes  contribute  to  both  roll  and  yaw  rate,  and  for 
ov,,,,  the  bow  planes  contribute  to  pitch  angle  and  depth 
rate.  In  Figure  3.5(b),  for  cr-^.,  we  observe  the  stern 
planes  and  rudder  contribute  to  depth  rate  and  pitch  angle, 
while,  for  '■T44,  the  rudder  contributes  primarily  to  roll 
angle  and  yaw  rate. 

3.7  Summary 


This  chapter  concentrated  on  describing  the  technique 
of  modal  analysis  and  its  ability  to  determine  the 
ei genstructure  and  modal  decomposition  of  the  state  space 
description  of  a  linear  model. 

The  use  of  modal  analysis  has  allowed  the  formulation 
of  the  prerequi si tes  necessary  to  pursue  the  LQG/LTR  design 
methodology  which  will  be  discussed  in  the  following 
chapter.  These  prerequi si tes  are  that  the  open  loop  linear 
model  is  detectable  and  stab i 1 1 z ab 1 e ,  and  that  the  location 
of  non-minimum  phase  zeros  be  known. 
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CHAPTER  FOUR 


MULTIVARIABLE  CONTROL  SYSTEM  DESIGN 

4.1  Introduction 

In  this  chapter,  a  controller  is  designed  using  the 
LQG/LTR  design  methodology.  The  singular  value  loop  shaping 
approach  is  used  to  obtain  desirable  singular  values  of  the 
system  transfer  function  matrix  to  meet  the 
specifications  of  performance  and  robustness  to  plant 
uncertainties  and  modelling  errors. 

The  chapter  begins  with  a  description  of  the  LQG/LTR 
design  methodology,  and  specifications  to  which  the 
controller  will  be  designed. 

Section  4  of  the  chapter  is  involved  with  the 
design  of  the  controller,  and  its  application  with  LQG/LTR. 
The  last  section  of  the  chapter  describes  the 
closed  loop  system,  which  will  be  tested  and  analyzed  in 
Chapter  Five. 

4.2  The  LQG/LTR  Design  Methodology 

The  multivariable  LQG/LTR  design  methodology  consists 
of  four  major  steps  C181. 

The  first  step  is  the  development  of  a  low  frequency 
model  of  the  nominal  plant  and  determination  of  modelling 
uncertainties.  For  purposes  of  good  command  following  and 
disturbance  rejection,  the  frequency  range  of  interest  is  at 
low  frequencies  <<10  rad/sec). 


.VVa' 
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The  modelling  uncertainty  in  the  nominal  model  due  to 
sensor  noise,  unmodelled  dynamics,  and  actuator  dynamics,  is 
assumed  to  be  concentrated  at  high  -frequencies.  Fixing  the 
crossover  -frequency  o-f  the  singular  values  o-f  the  loop 
transfer  -function  matrix  Mill  determine  the  significance  of 
the  unmodelled  dynamics,  and  the  ability  of  the  plant  to 
meet  command  following  specifications. 

The  actual  linear  time  invariant  plant  and  the  nominal 
model  at  low  frequencies  are  assumed  to  be  identical,  and 
determination  of  the  modelling  uncertainty  will  not  be 
performed  in  this  thesis.  As  a  result,  step  one  is  limited 
to  development  of  the  linear  model  and  determination  of  the 
maximum  allowable  crossover  frequency. 

The  second  step  of  the  design  process  establishes  the 
low  frequency  performance  requirements.  The  state  space 
block  diagram  of  the  compensated  plant  is  shown  in  Figure  4.1. 


d(s) 


Figure  4. 1  Block  Diagram  of  a  MIMO  Compensated  Plant 


where: 

r(s)  =  reference  signal  or  command  input  vector 

e(s)  =  error  signal  vector 

u(s)  =  control  vector  to  the  plant 

Y<s)  =  output  vector  of  the  plant 

d(s)  =  disturbance  vector  at  the  plant  output 

K(s)  =  compensator  transfer  function  matrix 

GCs)  =  augmented  plant  transfer  matrix 

The  transfer  matrix  G<s)  contains  the  nominal  low 
frequency  model  G^ts)  and  any  augmenting  dynamics  G^(s), 
and  is  defined  the  nominal  design  model.  Thus 

6 (s>  =  G<s)  G  (s).  (4.1) 

—  -p  — a 

To  determine  the  requirements  of  K(s) ,  the  overall  loop 
transfer  function  of  the  closed  loop  system  is  analyzed, 
where 

£<s>  =  C_I  +  G<s)K<s)  J-1d<s)  «■  +  G<s)K(s)  3~*G(s) K(s)r(s)  . 

For  good  command  following,  }r(s)  z  r (s) ,  and  for  disturbance 
rejection,  the  effect  of  d(s)  must  be  kept  small.  If  the 
minimum  singular  value  of  G(s)K(s)  is  large  with  respect  to 
unity  at  frequencies  below  crossover,  both  of  these 
requirements  can  be  met.  Likewise,  for  frequencies  above 
crossover ,  the  response  of  the  outputs  with  respect  to 
sensor  noise  can  be  minimized  and  stability-robustness 
enhanced  if  the  maximum  singular  value  of  G(«)K(s)  is  small 
with  respect  to  unity. 
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Combining  the  above  conditions,  we  essentially  impose 
high  and  low  -frequency  barriers  on  the  singular  value  plots 
of  G(s)K(s),  as  shown  in  Figure  4.2. 


Logfftjwr) 


Figure  4.2  Plot  o-f  Desired  Singular  Value  Shapes 

The  high  -frequency  barrier  imposes  a  robustness  constraint 
on  the  compensator  and  the  low  frequency  barrier  imposes  the 
command  following  and  disturbance  rejection  requirements. 

The  third  step  of  the  design  process  is  determining  the 
compensator  transfer  function  matrix,  K(s) ,  that  will 


provide  the  singular  values  of  G(s)KCs)  shown  above.  This 


step  of  the  process  is  appropr i atel y  termed  “loop  shaping". 

The  Kalman  Filter  methodology  is  first  applied  to  the 
nominal  design  model.  This  produces  a  transfer  matrix 
^KF<S>  that  has  the  desired  singular  value  loop  shapes.  A 
distinction  is  noted  in  this  procedure  however,  because  the 
KF  theory  is  applied  in  a  specific  manner  which  is  not  to  be 
confused  with  optimal  state  estimation. 

Recall  from  Chapter  2,  the  nominal  state  space 
description 

x  <t>  =  A  x_(t)  +  B  u  (t )  (4.2) 

£<t>  =  £  x  <t>  •  (4.3) 


This  description  is  modified  to  reflect  the  process  and 
measurement  noise 


x<t)  =  A  x(t)  +  L  *<t>  (4.4) 

£<t)  »  C  x(t)  +  «<t) ,  (4.5) 

where: 

=  process  white  noise  with  X  intensity  matrix 
®<t)  =  measurement  white  noise  with  ^.1.  intensity 
matr i x . 


The  design  parameters  p.  and  L  are  used  to  produce  the 
desired  loop  shapes  of  the  transfer  matrix  G^p(s)  where 


§^(5)  =  CCsI.  -  A:-1H  (4.6) 

H  =  <1 /,/>.)  £C'  ,  (4.7) 


and  E  is  the  solution  to  the  Filter  Algebraic  Riccatti 
Equation  (FARE) 


O  =  AE  +  EA '  +  LL'  -  <!/./>.)  EC  'CE. 


(4.8) 


For  a  specific  value  of  jl,  the  transfer  matrix  (3,<F<S)  can  be 
approximated  quite  readily.  Since  at  high  and  low 
frequencies  s  =  ju, 

-FOL <S)  =  -  A1_1L,  and  (4.9) 

ariC£KF<*)3  *  <l/^>®-iCGFQL(s)  3, 

then  the  L  matrix  can  be  chosen  in  a  way  to  produce  the 
desired  loop  shapes  and  )l  can  then  be  used  to  adjust  the 
singular  values  up  or  down  to  meet  the  required  crossover 
frequency  specifications. 

As  long  as  CA,LJ  is  stabilizable  and  CA,C3  is 
detectable,  then  any  choice  of  jt.  and  L  will  provide  the 
fallowing  guaranteed  properties  for  §£p(s): 


1.  closed  loop  stable 

2.  robust 


'„inCI  *  Skf'*13  *  1 

'„inCl  *  ®KF_1 <mt 3  4  1/2 

3.  infinite  upward  gain  margin 

4.  6  dB  downward  gain  margin 

5.  ±  60°  phase  margins 


The  fourth  and  final  step  of  the  design  process 
involves  the  "recovery"  of  the  loop  shapes  of  g^-(s)  by  the 


compensated  plant  transfer  matrix  G(s)K(s).  This  is  done  by 
solving  the  Control  Algebraic  Riccatti  Equation  (CARE) 


0  =  -KA  -  A ' K  -  qC'C  +  KBB ' K ,  for  q  >  0,  (4.10) 

Using  the  design  parameter  q,  and  defining  the  control  gain 
matrix 


G  =  B'K.  (4.11) 

For  a  valid  solution  of  the  CARE,  three  conditions  are 
necessary: 


1.  CA,B3  must  be  stabi 1 i zabl e , 

2.  [A, Cl  must  be  detectable,  and 

3.  The  nominal  design  plant  must  not  have  non¬ 

minimum  phase  zeros. 

When  calculated  using  the  above  procedure,  the  Filter 
gain  matrix  H  and  the  Control  gain  matrix  G  define  a  special 
type  of  compensator  known  as  a  "Model  Based  Compensator" 

(MBC) ,  designated  as  This  compensator  differs  from 

other  LQG/LTR  compensators  only  in  the  manner  in  which  G  and 
H  are  calculated.  The  state  space  description  of  the  MBC  is 

z  (t)  =  (A  -  BG  -  HQ)  z  (t)  -  H  e(t)  (4.12) 

u(t>  =  -  G  Z (t) ,  (4. 13) 

and  is  shown  pictorially  in  Figure  4.3. 


Providing  the  plant  is  minimum  phase  C23,  the  singular 


values  o-f  S  (s)  K,  (s)  converge  to  the  singular  values  o-f 
GKp(s)  as  the  design  parameter  q  -*  co.  Above  crossover 
-frequencies,  additional  rolloff  is  produced  by  the  recovery 
phase,  which  further  enhances  the  high  frequency  robustness 
characteristics.  As  a  result,  the  loop  shape  of  G^p(s)  is 
recovered,  and  the  resulting  controller  will  have  the 
desired  performance  characteri sties. 

4.3  Controller  Specifications 

Performance  specifications  outlined  in  this  thesis  are 
not  all  encompassing  and  do  not  necessarily  reflect 
established  Navy  specifications  for  submarine  control 
systems.  The  performance  requirements  are  mainly  driven  by 
the  intuitive  engineering  approach  to  obtain  good  command 
fallowing,  good  system  response,  robustness,  and  disturbance 
rejection.  These  performance  requirements  will  be  met 
through  loop  shaping  techniques. 

Two  performance  requirements  are  imposed  on  the 
controller  design.  First,  the  steady  state  error  to  step 
commands  and  step  disturbances  is  to  be  zero.  Second,  the 
maximum  crossover  frequency  is  limited  by  the  ability  of  the 
submarine  to  respond  and  by  the  rate  at  which  the 
compensator  deflects  the  control  surfaces. 

The  zero  steady  state  requirement  is  met  by  placing 
integrators  in  each  of  the  four  input  channels.  Since  the 
error  signal  appears  at  the  input  to  the  plant,  this  is 


where  the  integrators  will  be  placed.  In  this  manner,  the 
integrators  will  then  become  part  o-f  the  compensator  which 
is  before  the  plant  in  the  feedback  loop.  Note  that  the  use 
o-f  integral  control  in  the  input  channels  will  not  prevent 
the  specification  for  maximum  crossover  frequency  from  being 
met . 

The  maximum  crossover  frequency  of  the  compensator 
determines  the  rapidity  of  the  control  surface  deflections 
based  on  the  error  signals  which  are  generated  by  the 
difference  between  the  reference  commands  and  the  measured 
outputs.  Various  models  were  analyzed  during  this  research 
to  determine  the  effects  of  the  maximum  crossover  frequency. 
As  the  maximum  crossover  frequency  was  varied  from  0.1 
rad/sec  to  1.0  rad/sec,  two  major  observations  were  made. 

The  first  observation  was  that  for  high  crossover 
frequencies  the  dynamic  response  of  the  submarine  reacted 
more  quickly  and  improved.  The  second  observation  was  that 
the  control  surface  deflections  occurred  more  rapidly,  which 
contributed  to  the  improved  dynamic  response  of  the 
submarine.  Since  actuator  dynamics  are  not  directly 
modelled  in  this  thesis,  the  maximum  crossover  frequency  was 
selected  based  on  control  surface  deflections  which 
approximate  actuator  dynamics  as  listed  in  section  3.3. 

Although  not  explicitly  stated  as  a  performance 
specification,  from  the  performance  aspect,  it  is  desirable 
to  have  all  singular  values  cross  over  at  about  the  same 


frequency. 


Also,  on  the  high  frequency  side,  the  controller 


must  be  capable  of  rejecting  noise  and  be  robust  to  high 


-frequency  modelling  errors.  Noise  sources  generally 
originate  from  the  environment,  or  from  the  sensor  itself. 
Sensor  noise  typically  occurs  at  a  higher  frequency  than  the 
system  bandwidth  and  should  not  affect  the  dynamics  of  the 
ship  since  ship  eigenvalues  will  typically  lie  in  the  lower 
frequency  band. 

4.4  Controller  Design 

4.4.1  Augmentation  of  the  Model  Dynamics 

Augmenting  the  dynamics  of  the  submarine  control  system 
normally  serves  a  dual  purpose.  One  is  to  model  the 
actuator  dynamics  to  make  the  model  as  accurate  as  possible 
and  to  achieve  desirable  rolloff  at  crossover  for 
robustness.  The  other  is  to  include  integrators  to  cause 
the  compensator  to  permit  the  submarine  to  achieve  zero 
steady  state  error  to  step  inputs  and  disturbances  <  i.e., 
good  command  following).  The  actuator  dynamics  are  above 
the  maximum  expected  crossover  frequency,  and  thus  are 
neglected  [11,12,133.  This  is  perfectly  valid  as  long  as 
the  rolloff  above  crossover  is  fast  enough  and  satisfies  the 
robustness  criteria. 

A  block  diagram  of  the  augmented  model  appears  in 
Figure  4.4.  It  is  seen  that  the  integrators  are  placed  in 
the  control  channels.  The  mathematics  of  the  augmented 
states  will  be  manipulated  in  such  a  way  as  to  provide  a 
means  to  achieve  the  desired  loop  shapes  of  gFO,(s). 


Figure  4.4  Integrators  placed  in  the 
control  channel  of  plant. 

Me  de-fine  the  augmentation  dynamics  by  Ga(s),  whose 
state  space  description  is 

Up(t)  =  uc<t>  ;  Ga<s)  =  i/s 

where  each  matrix  is  C4  x  43.  The  augmenting  dynamics  are 
introduced  to  the  3th  order  system  using  state  space 
multiplication,  producing  a  12th  order  system.  Note  that 
the  physical  input  to  the  plant  is  labelled  u^Is)  to 
distinguish  it  from  the  output  of  the  compensator  < s ) . 

Although  the  augmentation  dynamics  Ga<s)  will  eventually  be 
lumped  with  the  compensator,  they  are  kept  separate  until 
the  LQG/LTR  procedure  is  complete.  Figure  4.5  shows  a 
comparison  of  the  unaugmented  and  augmented  model.  As 
shown,  the  integrators  at  the  input  produce  a  high  dc  gain 
increase  at  0.001  rad/sec. 


4.4.2  Kalman  Filter  Loop  Design 

In  section  4.2,  it  mss  stated  that  at  high  and  low 
■frequencies  the  singular  values  of  the  Kalman  filter 
transfer  function  matrix  are  approximated  by  the  singular 
values  of  ( 1  / ■/>>  §pql  <s>  .  For  each  choice  of  GpQL(s)  is 
easily  calculated  using  available  software. 

To  meet  the  loop  shaping  requirements  displayed  in 
Figure  4.2,  the  maximum  and  minimum  singular  values  of 
Gj^pCs)  should  be  identical  at  high  and  low  frequencies,  and 
as  close  as  possible  at  crossover.  The  choice  of  the  design 
parameter  L  will  thus  be  based  on  this  philosophy. 

Recall  from  section  4.2  that  G(s)  =  G  (s)G  (s),  and 

-  -p  -a  ’ 

define  G(s)  =  CCsI  -  AD-1B,  where 


and 
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At  low  frequencies,  sI-A_  x  -A  and  Csl-A  1  —A  * . 

P  “P  ~  ~P  ~p 

Since  A  has  distinct  and  non-zero  eigenvalues,  A  1  exists, 
-p  ~P 

We  now  partition  the  L  matrix  into  Lj  and  L21  where  Lj  will 


be  selected  for  low  frequency  matching,  and  L2  will  be 
selected  for  high  frequency  matching. 
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(4. 14) 


It  is  now  seen  that  the  singular  values  can  be  matched  at 


low  -frequencies  if  we  select  the  matrix  Lj  as  follows: 


L.  =  —  C  CA~ 1 B  1  ~ 1 
1  PP  -p 


(4. 15) 


At  high  frequencies,  sI-A_  si,  and  Csl-A  1  1  x  I/s. 
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Forming  GpOL < s )  for  high  frequencies, 
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The  singular  values  can  now  be  matched  at  high  frequencies 
if  we  select  L ^  as  follows: 

l2  =  ep'<£PVr1’  <4.16) 

since  as  s  -*  co,  1/s  >  l/s"4",  and  the  second  term  dominates 
the  maximum  singular  values. 

The  above  method  for  constructing  the  L  matrix  provides 


the  designer  with  a  guarantee  of  identical  behavior  of  the 
Kalman  filter  loop  singular  values  at  both  high  and  low 


-frequencies.  However,  this  method  does  not  provide  an 
opportunity  to  directly  control  the  shape  o-f  the  singular 
values  at  crossover. 

Once  the  ^  matrix  is  determined,  the  parameter  ^  is 
used  to  move  the  singular  value  plots  up  or  down  to  obtain 
the  desired  crossover  -frequency.  Then  we  can  solve  the  FARE 
and  calculate  G^p(s).  The  -final  value  of  jl  used  for  the 
model  during  the  Kalman  filter  design  process  is  4.  The 
Kalman  filter  gain  matrices  are  included  in  Appendix  E. 

Figure  4.6  is  a  plot  of  the  singular  values  of  the 
Kalman  filter  transfer  matrix  Gj-ql (s)  for  the  L  matrix  as 
defined  in  equations  4.15  and  4.16,  and  for  =  4.0. 

Although  the  singular  values  match  at  high  and  low 
frequencies,  some  differences  exist  at  crossover. 


If  the  dynamic  response  of  the  model  is  not 


satisfactory,  it  is  necessary  to  investigate  the  elements  of 
the  transfer  function  matrix  SFgS  (s)  in  an  attempt  to 
control  the  separation  of  the  singular  values  at  crossover. 
The  purpose  is  to  achieve  a  scaling  matrix  for  Cp  which  will 
result  in  a  tight  crossover  pattern  of  the  singular  values. 

4.4.3 _ Application  of  LQG/LTR 

As  stated  in  the  overview  of  the  LQG/LTR  design 
procedure,  once  the  Kalman  filter  design  is  complete,  the 
remainder  of  the  design  process  is  quite  strai ghtf orward . 

It  is  now  necessary  to  choose  the  design  parameter  q, 
and  solve  the  CARE  to  obtain  the  K  matrix.  Then,  we 
determine  the  Control  gain  matrix 

G  =  B'K. 

Recall  that  for  this  recovery  method  to  work  well,  the 
submarine  model  must  not  have  low  frequency  transmission 
zeros.  A  value  of  q  =  1000  was  used  for  the  model, 
producing  the  Control  gain  matrices  in  Appendix  El. 

The  entire  design  sequence  is  summarized  in  Figure  4.7, 
which  are  the  singular  value  plots  of  GKp(s)  ,  and 

G(s)K(s).  The  minimum  and  maximum  crossover  frequencies  are 
0.2  rad/sec  and  0.5  rad/sec,  respectively. 


Itg(*lngular  vrtu*)  20  *  log(ilnguior  v«lu«)  20  *  t»g(>ln)ulgr  mJut) 


The  closed  loop  system  can  be  written  in  state  space 
•form  as 


where: 

x(t)  -  the  state  o-f  the  nominal  design  model,  and 

z(t)  -  the  state  o-f  the  compensator. 

The  poles  and  zeros  -for  the  closed  loop  system  are 
contained  in  Appendix  El.  Since  all  the  poles  are  in  the 
le-ft  half  plane,  the  system  is  in  fact  stable. 

Referring  to  the  overall  loop  transfer  function  of  the 
closed  loop  system  (section  4.2) ,  from  command  input  to 
output,  then  the  singular  values  of  the  closed  loop  plant 
should  be  approximately  0  dB  from  dc  up  to  the  crossover 
frequency,  and  then  rolloff  at  frequencies  above  crossover. 
This  is  shown  in  Figure  4.8,  which  is  a  singular  value  plot 
of  the  closed  loop  system. 


omaga  (rod/sac) 


Figure  4.8  Singular  Values  of  the  Closed  Loop 

The  singular  values  o-f  the  compensator  are  shown  in 
Figure  4.9.  Here  we  observe  the  lead-lag  character i sti cs  o-f 
the  compensator  over  the  frequency  range  of  interest.  Note 
the  large  amplifications  at  frequencies  below  crossover. 

The  large  spread  in  the  singular  values  indicates  certain 
directions  are  being  amplified  more  than  others. 


Figure  4.9  Compensator  Singular  Values 

Figure  4.10  represents  the  singular  values  -for  the  loop 
transfer  -function  broken  at  the  plant  input  instead  o-f  the 
plant  output.  Re-ferring  back  to  Figure  4.1,  we  see  that  the 
plots  represent  the  net  ampl  i  -f  i  cat  i  on  -from  reference 
commands  r (s)  to  the  controls  (s) ,  where 

-  -p 

u  <s>  =  Cl  +  K(s)G(s) D_1K(s)  r(s)  . 

_p  _  _  _  _  _ 

The  -figure  shows  that  there  are  certain  directions  where 


amplification  is  required  more  than  in  others. 


also  presented. 
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4.7  Summary 

This  chapter  demonstrated  the  application  of  the 
LQG/LTR  control  system  design  methodology.  Specifications 
for  the  controller  design  Mere  also  presented,  and  then  the 
methodology  was  applied  to  the  design  of  a  submarine  control 
system. 

Compensator  designs  were  studied  for  various  crossover 
frequencies,  and  then  a  compensator  Mas  selected  which 
provided  system  response  characteristics  which  were 
desirable,  and  which  deflected  the  control  surfaces  in  a 
reasonable  manner. 

Additionally,  summary  plots  of  the  design  sequence  for 
a  control  system  design  without  active  roll  control 
capability  was  also  provided. 

Figure  4.12  represents  the  final  closed  loop  design  on 


which  Chapter  Five  is  based 


CHAFTER  FIVE 


EVALUATION  OF  THE  MODEL  BASED  COMPENSATOR 

5.1  Introduction 

In  this  chapter,  the  performance  of  the  controller 
design  is  evaluated.  The  controller  is  tested  using  both 
the  linear  and  non-linear  submarine  simulations  to  determine 
how  closely  the  performance  specifications  are  met,  and  to 
test  for  instabilities  in  the  design. 

The  4-input,  4-output  design  is  also  compared  to  a  3- 
input,  3-output  design  that  does  not  have  the  capability  of 
active  roll  control.  The  comparisons  provide  a  measure  of 
performance  improvements  for  the  submarine  when  active  roll 
control  using  the  differential  stern  planes  are  employed. 

5.2  Implementation  of  the  Compensator 

To  implement  the  compensator  on  the  computer  facility 
at  Draper,  programming  changes  were  necessary  in  two 
subroutines  which  are  needed  by  the  submarine  simulation 
program.  Subroutines  OUTFTS  and  MBDCMP  were  modified  to 
reflect  scaling  for  consistent  units  from  radians  to 
degrees.  Additionally,  to  maintain  a  properly  scaled  error 
vector  to  the  compensator,  it  was  necessary  to  apply 
appropriate  scaling  matrices  to  the  B  and  C  matrices  of  the 
MBC.  These  matrices  reflect  the  weightings  which  were 
applied  to  the  input  and  output  vectors  of  the  open  loop 
model  during  the  compensator  designs  of  Chapter  Four. 


the  compensator  was  designed,  were  replaced  with  the 


submarine  simulation  program  to  evaluate  the  performance  o-f 
the  compensator.  This  implies  then,  that  the  error  vector, 
e<t),  at  the  input  to  the  Model  Based  Compensator  is  always 
the  true  difference  between  the  commanded  input  and  the 
output  variables. 

Figure  5.1  displays  how  the  MBC  feedback  configuration 
for  this  design  is  modified  by  scaling.  The  block 
identified  as  COMP  is  now  the  MBC  with  the  augmenting 
dynamics  as  discussed  in  the  previous  chapter.  Describing 
the  MBC  with  A,  B,  and  C  matrices  (as  shown  in  section  4.5) 

*V  J  «v 

we  now  include  the  scaling  matrices  £>u  and  into  the 
compensator,  and  define  the  resulting  compensator  as  the 
compensator  provided  to  the  computer  simulation  at  Draper. 


Figure  5.1  Modi f i cati ons  of  the  MBC  Feedback  Design 
for  Weightings  on  Inputs  and  Outputs 


5.3  Testing  of  the  Compensator  Design 

The  LQG/LTR  compensator  design  was  tested  by  providing 
the  computer  simulation  at  Draper  with  a  data  file 


?■ 


the  computer  simulation  at  Draper  with  a  data  -file 
containing  time  sequenced  command  inputs  and  then 
integrating  either  the  linear  or  non-linear  equations  of 
motion.  Transient  and  steady  state  maneuvers  were  performed 
to  validate  the  resulting  designs.  To  provide  comparisons 
-for  the  various  models,  however,  only  the  steady  state 
maneuvers  will  be  displayed  in  this  thesis. 

The  evaluations  o-f  the  Model  Based  Compensators  are 
performed  by  first  comparing  the  linear  and  non-linear 
simulations  of  the  roll  control  model.  The  evaluations  are 
completed  by  comparing  a  second  MBC,  designed  without  roll 
control  capability,  to  the  MBC  designed  with  roll  control 
capabi 1 i ty . 

5.4  Comparison  of  the  Linear  and  Non-linear  Simulations 

Use  of  the  LQG/LTR  design  methodology  allows  us  to 
analyse  the  linear  and  non-linear  applications  of  the  design 
to  ascertain  whether  the  design  is  valid.  Discounting 
effects  due  to  non— 1 i near i t i es ,  the  resulting  linear 
simulation  provides  a  prediction  of  initial  derivatives, 
natural  frequencies,  and  damping  effects  which  can  be 
expected  in  the  non-linear  simulation. 

Figure  5.2  represents  a  comparison  of  the  linear 
(LQG/LTR)  and  non-linear  responses  of  the  submarine 
simulation  for  a  commanded  1.5°  pitch  angle.  In  the  linear 
model,  we  observe  that  the  forward  velocity  is  essentially 
constant,  while  in  the  non-linear  model  we  observe  a 
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decrease  o-f  approximately  0.5  knots  in  the  ship's  -forward 
velocity.  Because  the  linear  model  neglects  the  non-linear 
dynamics  o-f  the  submarine,  we  see  a  roll  angle  develop  for 
the  linear  model  which  causes  a  heading  change  and  depth 
excursion  which  is  much  more  significant  than  in  the  non¬ 
linear  response. 

Comparing  the  control  surface  deflections,  we  see  that 
the  linear  model  requires  slightly  more  deflection  to  obtain 
the  desired  response,  which  indicates  that,  in  the  linear 
case,  the  control  surfaces  are  less  effective.  The  fact 
that  the  linear  model  indicates  less  control  surface 
authority  explains  the  fact  that  the  controller  error  signal 
does  not  disappear  until  much  later  than  in  the  non-linear 
simulation. 

For  completeness,  the  outputs  are  also  provided.  Note 
that  the  outputs  essentially  exhibit  the  mirror  image  of  the 
controller  error,  but  additionally  provide  indication  of  the 
true  output  in  the  variable  commanded  for  the  maneuver,  in 
this  case,  pitch  angle  B. 

The  purpose  of  this  comparison  was  to  establish  the 
validity  of  both  the  compensator  design,  and  the  computer 
software  used  for  the  simulations.  This  was  particularly 
important  because  of  the  modifications  made  to  the  computer 
subroutines  for  scaling  and  selection  of  output  variables. 
The  simulations  performed  in  the  next  section  use  only  the 
non-linear  computer  models. 
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Having  established  the  validity  o-f  the  compensator 
design  and  the  compensator  software,  it  is  now  necessary  to 
demonstrate  the  performance  character i sti cs  of  the  roll 
control  model  as  compared  to  a  comparably  designed 
compensator  without  roll  control  capability. 

Using  the  criteria  presented  in  Chapter  Four,  a  Model 
Based  Compensator  was  designed  which  does  not  have  roll 
control  capability.  The  elimination  of  roll  angle,  a,  as  a 
state  of  the  output  vector  resulted  in  an  input  vector  u(t) , 
where 

M 

u(t)  =  &r  and  &s  =  fcSj^  +  £5,,  . 

L&sJ 

Information  regarding  the  state  space  descriptions  of  the 
model  without  roll  control  capability  is  provided  in 
Appendix  C4.  Modal  analysis  results  are  provided  in  Appendi 
D2,  and  properties  of  the  closed  loop  system  are  provided  in 
Appendix  E2. 

To  allow  comparisons  between  the  two  models  that 
provide  useful  information,  the  same  design  parameters  were 
used  for  both  models.  The  output  vector  for  this  model  is 
^(t) j  where 

*<t>  *  C  §<t>  y(t)  z(t)  DT  . 

Comparisons  are  made  for  four  simulations.  The  first 
two  simulations  are  for  heading  changes  by  commanding  a  step 


input  of  1  deg/second,  and  2  deg/second,  respectively.  The 
intent  o-f  these  two  simulations  is  to  display  the  submarine 
trajectory  when  a  steady  turning  rate  is  commanded.  A 
larger  commanded  heading  rate  should  accelerate  the 
nonlinear  character  i  sti  cs  o-f  the  system.  The  third 
comparison  is  -for  a  combined  maneuver  in  which  step  commands 
o-f  1  degree  o-f  pitch,  0.5  feet/second  o-f  depth  rate,  and 
1  degree/second  o-f  heading  change  are  provided  to  the 
compensators.  The  -fourth  simulation  is  less  detailed  than 
the  three  preceding  ones,  however,  the  commanded  turning 
rate  is  3  degrees/second,  and  provides  additional  insight 
into  the  di -f -f erences  in  the  two  compensators. 

In  all  -four  simulations  the  commands  are  applied  as 
step  inputs  at  t  =  5  seconds.  Additionally,  in  the 
simulations  for  the  design  without  roll  control,  the  stern 
plane  deflections  &s1  and  &s~,  are  shown  separately  to 
further  illustrate  the  stern  plane  deflections  in  the  design 
with  roll  control. 


5.5.1  Mild  Turning  Maneuver 

Figure  5.3  displays  the  results  of  commanding  a  mild 
turning  maneuver  of  1  deg/sec.  For  this  turning  rate,  the 
ship  experiences  a  decrease  in  forward  velocity  of  6’/.. 

Looking  first  at  the  design  with  roll  control ,  we 
observe  that  the  submarine  initially  rolls  outward,  then 
snap  rolls  into  the  turn  at  t  =  12  seconds.  The  maximum 
inward  roll  angle  is  2°  at  t  =  22  seconds.  The  ship  has  a 


maximum  downward  pitch  angle  o-f  -1°.  The  ship  loses  8  -feet 
in  depth  during  the  entire  maneuver.  It  is  observed  the 
stern  planes  de-flect  di -f -f erenti al  1  y  to  compensate  -for  the 
roll  moment,  with  a  steady  state  di-f-ference  of  6°.  Note  the 
use  of  bow  planes  to  minimize  the  depth  rate.  Once  depth 
rate  error  has  been  eliminated,  the  bow  planes  return  to 
their  neutral  position. 

To  obtain  the  commanded  turning  rate,  the  rudder 
initially  deflects  5°.  As  the  error  in  yaw  rate  decreases, 
the  rudder  steadies  at  slightly  less  than  2°  deflection. 

Looking  now  at  the  model  without  roll  control ,  it  is 
immediately  observed  that  the  ship  experiences  a  snap  roll 
of  10°,  with  roll  angle  steadying  out  at  8°.  Due  to  the 
roll  angle,  and  the  effect  of  the  rudder ,  the  ship 
experiences  a  downward  pitch  angle  of  approximately  2°, 
which  causes  the  ship  to  experience  a  depth  loss  of  almost 
65  feet.  Because  the  roll  angle  is  contributing  to  the 
depth  rate,  the  bow  planes  are  deflected  7°,  with  stern 
plane  deflections  of  -1°.  The  combination  of  stern  planes 
and  bow  planes  are  minimizing  the  depth  excursion.  Note, 
however,  that  since  roll  angle  strongly  influences  pitch  and 
depth  rate,  that  these  two  terms  are  not  being  damped  as 
readily  as  they  were  in  the  roll  control  model. 
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This  simulation  is  -for  a  commanded  yaw  rate  o-f  2 
deg/sec.  Referring  to  Figure  5.4,  we  observe  a  25X  decrease 
in  forward  velocity.  The  model  with  roll  control 
experiences  an  outward  roll  of  6°,  then  snap  rolls  inward  to 
3°.  By  t  =  30  seconds,  the  roll  angle  is  essentially  zero. 
The  ship  initially  pitches  upward  due  to  the  outward  roll 
and  rudder  deflection.  When  the  snap  roll  occurs,  the  pitch 
angle  achieves  an  angle  of  -2°,  but  steadies  out  at  -1.3°  at 
t  =  55  seconds.  This  negative  pitch  angle  contributes  to 
the  constant  depth  rate  of  0.4  ft/sec.  The  significant  loss 
of  speed  contributes  to  the  lack  of  ability  of  the  control 
surfaces  to  minimize  vertical  plane  errors.  For  this 
simulation,  the  stern  planes  a  deflecting  a  difference  of 
12°  to  compensate  for  the  roll  moment  in  the  turn.  To 
minimize  depth  rate,  we  see  the  bow  planes  are  deflecting 
3°,  and  to  maintain  the  turn,  the  rudder  is  deflecting 
al most  3° . 

Comparing  the  model  without  roll  control,  we  observe 
the  ship  snap  rolls  inward  15°,  then  comes  to  a  steady  roll 
angle  of  12°.  Because  of  the  large  roll  angle,  the  ship 
pitches  down  6°  initially,  with  pitch  angle  coming  to  -2.5° 
at  t=  200  seconds.  The  depth  loss  in  the  turn  is  225  feet. 
The  bow  planes  almost  saturate  initially,  deflecting  to  18° 
to  counteract  the  depth  rate.  At  t  =  200  seconds,  the  bow 
planes  are  deflected  9°  (or  three  times  the  deflection  in 
the  roll  control  model).  The  rudder  is  deflected 
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approximately  8° ,  which  is  similar  in  the  roll  control 
model.  Additionally,  the  stern  planes  are  deflected  to 
minimize  the  depth  rate,  whereas,  in  the  roll  control  model 
they  were  de-flected  only  to  minimize  roll  angle  because  the 
bow  planes  were  better  able  to  minimize  depth  rate. 
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5.5.5  Combined  Manauvar 

This  maneuver  is  -for  step  input  commands  o-f  -0.5  ft/sec 
in  depth  rate,  1  deg/sec  in  yaw  rate,  and  1  degree  in  pitch. 
Re-f erring  to  Figure  5.5,  we  observe  a  67.  decrease  in  the 
-forward  velocity. 

Looking  -first  at  the  model  with  roll  control,  it  is 
observed  that  the  errors  in  roll  angle  and  yaw  rate  are 
damped  by  t  »  40  seconds.  The  errors  in  pitch  and  depth 
rate,  however,  are  not  damped  until  t  =  140  seconds.  By 
t  =  200  seconds,  the  ship  has  experienced  a  depth  rise  o-f  80 
-feet.  Again,  the  stern  planes  are  deflected  differentially 
to  counteract  the  roll  moment,  with  a  steady  differential 
deflection  of  6°.  The  bow  planes  are  deflected  at  -1.5°  to 
maintain  the  commanded  depth  rate,  and  the  rudder  is 
deflected  -2°  to  maintain  the  commanded  yaw  rate. 

Comparing  the  design  without  roll  control,  it  is 
observed  that  the  ship  experiences  a  snap  roll  of  10°.  This 
roll  angle  causes  a  pitch  angle  of  -2°  which  results  in  a 
large  pitch  error.  In  fact,  at  t  *  200  seconds,  there  is 
still  an  error  in  pitch  of  0.5°,  or  50/1  of  the  commanded 
pitch  angle.  This  also  causes  a  -0.35  ft/sec  depth  rate 
instead  of  the  commanded  —.5  ft /sec.  The  net  result  of 
these  errors  is  displayed  in  the  depth  of  the  ship.  The 
depth  rise  in  this  design  is  25  feet,  instead  of  80  feet,  as 
in  the  model  with  roll  control.  Note  here,  that  a  depth 


rise  is  commanded. 


The  steady  state  stern  planes  angle  is  -0.75°,  which 
indicates  the  stern  planes  are  being  used  to  obtain  the 
ordered  pitch  angle.  Because  the  depth  rate  is  a  result  of 
the  combination  of  pitch  angle  and  ship's  speed,  we  observe 
the  bow  planes  are  being  used  to  obtain  the  ordered  depth 
rate.  In  the  roll  control  model,  the  ship  obtained  the 
ordered  pitch  angle  rather  quickly,  thus,  the  bow  planes  are 
deflected  in  the  opposite  direction  to  limit  the  depth  rate 
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This  maneuver  is  -for  a  commanded  yaw  rate  of  3  deg/sec, 
and  is  provided  to  display  the  effects  of  control  surface 
saturation.  Referring  to  Figure  5.6,  we  observe  a  drop  in 
ship's  speed  of  almost  45V..  Looking  at  the  model  with  roll 
control,  it  is  observed  that  the  ship  initially  rolls 
outward  approximately  8°,  then  snaps  inward  at  t  =  14 
seconds.  The  maximum  downward  pitch  angle  reaches  4°  at 
t  =  160  seconds,  and  starts  to  reduce  by  the  end  of  the  run. 
The  depth  loss  in  this  case  is  184  ft.  The  stern  planes 
again  deflect  differentially  to  counteract  the  roll  moment, 
but  now,  we  observe  the  port  stern  planes  are  deflected  at 
-3.9°  at  t  =200  seconds  whereas  the  starboard  stern  planes 
are  deflected  at  7.8°.  This  indicates  that  the  stern 
planes,  although  deflecting  differentially  for  roll  control, 
are  also  being  deflected  for  control  of  pitch  angle.  The 
bow  planes  are  deflected  at  6.25°  in  an  attempt  to  minimize 
depth  rate.  To  maintain  the  ordered  yaw  rate,  the  rudder  is 
deflected  -27°  at  the  end  of  the  run. 

Comparing  the  model  without  roll  control,  we  observe 
that  the  ship  snap  rolls  inboard  19°,  and  pitch  angle 
approaches  -12°.  The  stern  planes  deflect  to  limit  the 
pitch  angle,  and  the  bow  planes  deflect  to  limit  depth  rate. 
The  bow  planes,  however,  saturate  in  this  run  at  t  =  22 
seconds.  Up  to  this  point,  the  ship's  depth  was  maintained 
fairly  well.  As  soon  as  the  bow  planes  saturate,  the  depth 
rate  increases,  causing  the  ship  to  lose  depth.  This  causes 


the  stern  planes  to  de-flect  in  the  opposite  direction  in  an 
attempt  to  minimize  pitch  angle  and  depth  rate.  At  t  =  25 
seconds,  the  pitch  angle  steadies,  and  starts  to  come  off. 

At  t  =  108  seconds,  the  depth  rate  goes  negative,  and  it  is 
observed  the  bow  planes  come  out  o-f  saturation.  By  t  =  200 
seconds,  we  observe  that  the  roll  angle  has  been  reduced  to 
8°,  maximum  negative  pitch  angle  is  7°,  depth  rate  is 
significantly  reduced,  and  none  o-f  the  control  surfaces  are 
saturated.  Depth  at  the  end  of  the  run  is  820  feet,  which 
equates  to  a  depth  loss  of  320  feet,  as  compared  to  the  roll 
control  model's  depth  loss  of  184  feet. 

The  purpose  of  this  run  was  to  demonstrate  how  different 
the  submarine's  trajectory  is  when  the  control  surfaces 


saturate 
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Summary 


This  chapter  has  presented  the  implementation  o-f  the 
MBC  designed  in  Chapter  Four,  and  evaluation  o-f  the  closed 
loop  model.  The  linear  and  non-linear  simulations  were 
performed  to  demonstrate  how  the  predictions  -for  the  Kalman 
-filter  loop  o-f  the  linear  can  be  used  to  validate  the 
compensator's  use  on  the  non-linear  model. 

A  second  compensator,  designed  without  roll  control 
capability  was  presented,  and  then  used  to  display  the 
advantages  o-f  employing  differential  stern  planes  control  on 
full  scale  submarines. 
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CHAPTER  SIX 


SUMMARY,  CONCLUSIONS,  AND  DIRECTIONS  FOR  FUTURE  RESEARCH 


Summar\ 


This  thesis  has  presented  a  multivariable  control 
design  example  for  a  submarine  using  active  roll  control 
capabi 1 i ty. 

The  vehicle  model  was  based  on  the  NSRDC  2510  equations 
including  vortex  shedding  and  cross-flow  drag  terms.  These 
equations  were  linearized  to  generate  linear  models  o-f  the 
submarine  which  were  then  analyzed  and  verified. 

The  resulting  models  were  reduced  to  eight  order 
systems,  scaled,  and  then  subjected  to  modal  analysis,  which 
allowed  the  formulation  of  the  prerequi si tes  necessary  to 
pursue  the  LQG/LTR  design  methodology. 

Model  Based  Compensators  with  and  without  roll  control 
capability  were  designed  for  the  time  and  frequency  domains. 
Specifications  for  the  controller  designs  were  presented, 
then,  the  methodology  was  applied  to  the  design  of  submarine 
control  systems.  Compensators  were  designed  and  studied  for 
various  crossover  frequencies,  and  a  compensator  was 
selected  which  provided  desirable  closed  loop  system 
response  characteri sti cs. 

The  selected  compensator  was  evaluated  by  comparing  the 
linear  and  nan-linear  dynamic  simulations  and  determining 
how  closely  the  performance  specifications  were  met,  and 
also,  whether  instabilities  existed  in  the  design.  The  MBC 


was  then  compared  with  an  equivalent  compensator  which  did 
not  have  roll  control  capability. 

6.2  Conclusions 

Multivariable  control  system  design  using  the  LQG/LTR 
methodology  has  been  successfully  utilized  to  design  a 
submarine  control  system  with  roll  control  capability. 

It  has  been  demonstrated  that  modal  analysis  and 
decomposition  of  the  singular  values  of  the  plant  can  be 
used  effectively  in  control  system  design.  Modal  analysis 
allows  us  to  investigate  the  structure  of  the  linear  model 
and  consider  the  ability  to  control  and  observe  selected 
state  variables.  Singular  value  decomposition,  once 
understood,  can  be  used  in  a  similar  manner  as  Bode  plots, 
and  provides  a  convenient  way  to  describe  and  ensure  the 
performance  requirements  for  the  design. 

The  purpose  of,  and  techniques  used  to  scale  the  open 
loop  plant  were  discussed  in  rigorous  detail  because  the 
scaling  strongly  affects  the  singular  value  decomposition  of 
the  open  loop  plant,  and  the  resulting  compensator  design. 

The  purpose  of  this  thesis  was  to  demonstrate  the 
advantages  of  roll  control  on  a  full  scale  submarine.  A 
limited  number  of  simulations  were  performed,  and  the 
performance  of  the  submarine  with  roll  control  is  much 
improved  over  the  design  without  roll  control.  The  control 
system  was  designed  for  a  submarine  at  30  knots,  and  we 
observed  the  control  system  did  fairly  well,  even  for  a 


45/1  decrease  in  forward  velocity  of  the  ship.  Additionally, 
the  control  system  was  designed  using  the  inertial  reference 
frame  rather  than  the  body  reference  frame  of  the  ship. 

Use  of  the  fixed  inertial  coordinate  system  provided  better 
control  of  the  submarine  in  maneuvering  situations  than  for 
previous  designs  which  used  the  body  reference  frame. 

At  this  point  it  is  important  to  stress  the  following 
observations: 


•  The  performance  characteri sties  of  the  submarine 
with  active  roll  control  are  enhanced  considerably 
over  the  design  without  roll  control.  The 
simulations  demonstrated  considerable  depth 
improvement,  and  less  control  surface  deflections 
and  saturation  in  severe  maneuvers,  as 
demonstrated  in  Figure  5.6. 

•  This  thesis  demonstrates  a  technique  to  simulate 
performance  characteristics  of  "paper"  control 
systems  for  trade-off  studies  for  specified 
performance  criteria. 

•  One  model  cannot  be  used  to  globally  control  a 
submarine.  Although  the  compensator  performed 
well  with  large  variations  from  the  nominal 
operating  point,  reduced  effectiveness  of  the 
control  surfaces  was  observed. 

•  The  fact  that  only  small  perturbati ons  can  be 
applied  in  validation  of  the  design  is  not  a 
limitation  of  the  control  design  methodology.  It 
is,  however,  a  limitation  of  the  linear  model. 

•  Results  of  this  thesis  could  be  improved  upon  by 
including  actuator  dynamics,  then  selecting  the 
compensator  bandwidth  and  control  gains  to  provide 
the  best  desirable  ship  response  char acter i sti cs. 

•  To  demonstrate  the  flexibility  a  controls  engineer 
has  when  using  multivariable  control,  the 

bow/f airwater  planes  were  included  in  this  thesis. 
Use  of  the  bow/f airwater  planes  at  30  knots  may  not 
be  considered  practical  due  to  flow  noise  and 
disturbances,  and  structural  limitations. 
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This  thesis  provides  many  of  the  building  blocks 
necessary  to  re-fine  the  use  o-f  di -f -f erenti al  stern  planes. 
Including  actuator  dynamics  is  an  extension  that  needs  to  be 
completed.  Additionally,  limited  designs  were  conducted 
which  investigated  the  e-f-fects  o-f  compensator  bandwidth  and 
control  gains.  Much  more  work  needs  to  be  performed  in  this 
area. 

Another  area  which  needs  additional  research  is  in  the 
use  of  propulsion  as  a  dynamic  control  variable.  If 
propeller  rpm  is  allowed  to  vary,  the  control  system  design 
could  effect  maneuvers  while  minimizing  speed  loss  in  a  turn 
(within  propulsion  constraints). 

Finally,  an  area  which  is  rather  significant,  and  in 
which  serious  efforts  have  to  be  directed  is  in  the  area  of 
casualty  situations.  This  thesis  has  only  looked  at 
controlled  maneuvers,  in  which  the  control  system  performs 
it's  function  completely.  Failures  of  the  control  system 
during  submerged  operations  must  be  fully  investigated, 
understood,  and  designed  into  the  compensator. 


REFERENCES 


Athans,  M.  "The  Role  and  Use  of  the  Stoichastic 
Linear — Quadrat i c-Gaussi an  Problem  in  Control  System 
Design",  IEEE  Transactions  on  Automatic  Control,  Vo 
AC-16,  No.  6  (December,  1971):  pp  529-552. 

Athans,  M.  Multivariable  Control  Systems,  Course 
Lecture  Notes,  MIT,  Spring  1984. 

Brogan,  W.  L.  Modern  Control  Theory,  New  York, 
Quantum  Publishers,  Inc.,  1974. 

Doyle,  J.  C.  and  Stein,  G.  "Multivariable  Feedback 
Design:  Concepts  for  a  Cl assi cal /Modern  Synthesis", 
IEEE  Transactions  on  Automatic  Control.  Vol.  AC-26. 


No.  1  (February,  1981):  pp  4-16. 

Gertler,  M.  and  Hagan,  G.  R.  "Standard  Equations 
of  Motion  for  Submarine  Simulation",  Naval  Ship 
Research  and  Development  Report  2510,  June  1967. 

Kuo,  B.C.  Automatic  Control  Systems,  Englewood  Cliffs 
N.J.,  Prentice  Hall,  Inc.,  1982. 

Kwakernaack,  H.  and  Si  van,  R.  Linear  ODtimal  Control 
Systems,  New  York,  Wiley,  1972. 

ata.  K.  Modern  Control  Enaineerin 


Englewood  Cliffs,  N.J.,  Prentice  Hall,  Inc.,  1972. 

Tri antaf yl 1 ou ,  M.  S.  ,  Bodson ,  M.  and  Athans,  M.  "Real 
Time  Estimation  of  Ships  Motion  Using  Kalman  Filtering 
Techniques",  IEEE  Journal  of  Ocean  Engineering,  Vol. 
QE-8,  No.  1  (January,  1983),  pp  9-20. 

Lively,  K.  A.  "Multivariable  Control  System  Design 
for  a  Submarine",  Engineers  Thesis,  MIT,  1984. 


Dreher ,  L.  J.  "Robust  Rate  Control  System  Designs 
for  a  Submersible",  Engineers  Thesis,  MIT,  1984. 

Milliken,  L.  G.  "Multivariable  Control  of  an 
Underwater  Vehicle",  Engineers  Thesis,  MIT,  1984. 

Harris,  K.  A.  "Automatic  Control  of  a  Submersible", 
Masters  Thesis,  MIT,  1984. 


Bonnice,  B.  and  Valavani,  L.  "Submarine  Conf iguration 
and  Control",  CSDL  Memo  SUB  1-1083,  1983. 

Bonnice,  B.  CONSTRF'S  Fortran  and  Executive  Command 
Computer  Programs,  CSDL,  May,  1984. 


Abkowits,  M.  Stability  and  Motion  Control  o-f  Ocean 
Vehicles ,  MIT  Press,  Cambridge,  MA. ,  1969. 

Takahashi ,  Robins,  and  Auslander  Control .  Addison- 
Wesley,  1970,  pp  65-86. 

Athans,  M.  Mul ti var i abl e  Control  System  Design  using 
the  LQG/LTR  Methodology,  6.232  Lecture  Notes,  MIT, 
Spring  1984. 

Stein,  G.  "LQG-Based  Multivariable  Design:  Frequency 
Domain  Interpretation" ,  AGARD,  NATO,  1981. 

Kappas,  E.  "Robust  Multivarable  Control  -for  the  F-100 
Engine",  Engineer's  Thesis,  MIT,  1983. 


Boettcher,  K.  "Analysis  o-f  Multivarable  Control 
Systems  with  Structural  Uncertainty",  Internal  Report, 


Detailed  Definition  of  the  Submarine  Problem 


Any  submarine  must  meet  certain  minimum  standards  of 
control  1 abi 1 i ty .  Its  course  keeping  and  depth  keeping 
stability  must  be  adequate  for  tr ansportati on  at  the  maximum 
speed  and  at  a  low  but  useful  speed.  While  many  surface 
ships  and  many  submarines  are  directionally  unstable  to  a 
small  degree,  requiring  constant  attention  to  steer  an 
acceptable  straight  course,  the  consequences  of  a  mistake  or 
a  temporary  interruption  of  rudder  or  diving  plane  activity 
in  a  high  speed  submarine  make  it  imprudent  to  accept  even 
slight  instability.  For  this  reason,  definite  control -f i xed 
stability  is  required. 

Slow  speed  operation  of  a  combatant  submarine  is  often 
required.  Because  of  the  pendulum-like  hydrostatic 
stability  of  the  submarine,  as  the  submarine  moves  very 
slowly  through  the  water ,  the  hydrodynamic  effects  of  stern 
plane  deflection  are  too  small  to  change  the  submarine  hull 
angl e-of -attack  by  an  amount  large  enough  to  develop  rise  or 
dive  forces  on  the  hull.  The  net  vertical  force  on  the 
submarine  that  results  is  due  mostly  to  the  force  of  the 
stern  plane  itself,  which  is  always  in  the  direction 
opposite  to  the  conventional  rise  or  dive  command.  This 
phenomenon  is  often  referred  to  as  "stern  plane  reversal". 
This  particular  effect  can  be  controlled  by  proper  design 
and  building  of  the  ship  such  that  the  vertical  distance 
between  the  location  of  the  center  of  buoyancy  and  the 
center  of  gravity  of  the  ship  are  within  prescribed  max/min 
limits. 

At  or  near  zero  ship  speed,  control  of  the  ship's 
attitude  and  depth  using  forces  generated  by  flow  over  the 
hull  and  control  surfaces  is  not  possible.  Control  of  depth 
can  be  obtained  by  changing  the  weight  of  the  submarine 
using  the  trim  system. 


In  the  absence  of  external  force  disturbances,  such  as 
are  encountered  near  the  surface  under  a  seaway,  hovering  by 
application  of  small  weight  and/or  buoyancy  changes  has 
become  a  common  experience  for  submariners.  Quiet  seas, 


skill,  experience, 


an  opportunity  to  improve  the  trim 


while  slowing  to  hovering  speeds  are  all  necessary.  Lacking 
any  of  these  factors,  and  given  a  need  to  hover,  one 
immediately  recognizes  a  need  for  some  form  of  properly 
engineered  hovering  system. 


Each  submarine  must  operate  a  portion  of  its  service 
life  on  the  surface,  which  generates  a  different  set  of 
steering  parameters  and  requirements.  Adequate  surfaced 
steering  with  slight  directional  unstability  is  feasible,  so 
that  specific  values  of  directional  stability  on  the  surface 
are  not  necessary  or  even  useful.  Some  degree  of  steering 


servi ce 


control  while  backing  is  also  necessary  when  docking  or  -for 
in-port  maneuvering. 

The  attributes  o-f  combatant  service  that  affect 
controllability  and  performance  requirements  range  from 
those  associated  with  stealth  to  those  associated  with 
maximum  speed  violent  maneuvers.  Violent  maneuvers, 
involving  full  acceleration,  possible  course  reversals,  and 
severe  depth  changes  could  be  necessary.  The  prescribed 
Submerged  Operating  Envelope  (SOE)  should  be  the  same  for 
peacetime  and  wartime  operations.  The  maximum  exploitation 
of  speed,  depth,  and  maneuvering  capabilities  will  be  a 
necessity  to  prepare  for  potential  engagements  or  casualty 
environments  that  may  be  experienced  over  the  lifetime  of 
the  submarine. 

Underlying  all  combatant  submarine  attributes,  and  in 
many  cases,  dominating  them,  are  the  requirements  to  operate 
quietly.  Mandatory  noise  requirements  and  even  more 
stringent  desirable  goals  are  generally  imposed  on  all 
systems;  one  of  the  most  significant  contributors  to  the 
overall  noise  character i sties  are  operations  of  the  control 
surfaces,  thus,  the  ship  control  system  must  now  be 
optimized  to  minimize  this  noise  source. 

The  fact  that  the  submarine  is  a  "dirigible"  in  space, 
within  the  bounds  of  the  surface,  the  bottom,  and  collapse 
depth,  mandates  that  its  handling  properties  be  described  as 
a  set  of  horizontal  and  vertical  plane  properties.  The 
consequences  of  error  in  the  vertical  plane  that  can  be 
imagined  are  dramatically  different  from  those  in  the 
horizontal  plane.  Groundings  and  collisions  due  to 
horizontal  plane  error,  no  matter  how  distressing  to  the 
ship(s)  involved,  do  not  have  the  sense  of  finality  that 
sinkings  have.  For  this  reason,  the  highest  priority 
attention  is  given  to  vertical  plane  maneuvering  properties 
and  vertical  plane  consequences  of  horizontal  plane 
maneuvers.  The  remaining  mobility  characteristics,  course 
and  speed,  are  ranked  in  priority  in  that  order. 

With  depth  factors  as  the  first  priority,  the  criteria 
for  judging  the  quality  of  vertical  plane  maneuvers  will  be 
based  upon  reliability  and  precision  of  control  at  constant 
ordered  depth,  and  upon  the  ease  of  making  ordered  depth 
changes. 

In  the  horizontal  plane,  it  is  rare  that  a  specific 
minimum  value  of  turning  diameter  would  be  critical  for  a 
submarine.  A  much  more  useful  turning  quality  to  impose  is 
the  time  to  change  heading  by  a  given  amount  (for  example 
30°,  180°,  etc.),  with  minimum  depth  keeping  disruption  and 
maximum  speed  remaining  when  the  turn  is  completed.  This  is 
a  property  which  can  be  perceived  by  the  operators.  Evasive 
maneuvers  are  very  likely  to  involve  large  changes  in 


speed,  course,  and  depth.  The  per-formance  o-f  the  submarine 
during  large  changes  should  provide  the  most  freedom  to  the 
operator.  It  must  be  possible,  with  confidence  in  the 
safety  of  the  maneuver,  to  order  simultaneous  speed,  course, 
and  depth  changes  in  any  combination.  This  requirement 
leads  to  the  addition  of  a  parameter  describing  the  required 
control  authority  in  the  vertical  plane  to  the  time  to  reach 
the  heading  change  requirement  within  a  specified  time 
period.  The  depth  change  limitation  associated  with  turns 
must  be  met  using  only  a  portion  of  the  available  depth 
control  authority.  The  remaining  depth  control  authority 
that  is  not  used  in  a  flat  turn  could  be  used  to  enforce  a 
simultaneous  depth  change. 
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Summary  of  the  SUBMODEL  Program 

The  SUBMODEL  program  was  written  to  per-form  any  of  the 
■following  tasks: 

1)  Integrate  the  nonlinear  equations  of  motion  of  a 
submarine. 

2)  Search  for  a  local  equilibrium  point  in  the 
nonlinear  equations  of  motion.  (A  local 
equilibrium  point  is  the  point  where  the 
derivatives  of  the  state  variables  chosen  are 
zero. ) 

3)  Calculate  the  linearized  dynamics  about  a 
particular  nominal  point. 

4)  Integrate  the  linearized  equations  of  motion. 

This  description  of  the  SUBMODEL  program  consists  of 
three  sections.  Section  2  describes  briefly  the  equations 
of  motion  that  are  implemented  in  the  program.  Section  3 
describes  the  program. 

Section  Two:  Nonlinear  and  Linear  Equations  of  Motion 

This  section  describes  the  equations  of  motion  which 
have  been  implemented  in  the  SUBMODEL  program. 

The  nonlinear  equations  are  in  the  form 


Ex  =  f  <x  ,u) 

where 

x  =  10  x  1  state  vector 

y  *  n  x  1  control  vector  (n=user  specified) 
f  =  10  x  1  vector  that  is  a  nonlinear  function  of 
the  states  and  the  controls 
|  =  10  x  10  matrix 

The  first  nine  differential  equations  are  the  same  as 
the  688  nonlinear  equations  documented  in  CSDL  Memo  SUB  2- 
1083  except  for  three  propulsion  and  drag  terms.  These 
changes  are  documented  in  the  memo  on  propulsion  and  drag 
models.  The  nine  states  are  ordered  as  stated  in  the  main 
body  of  this  thesis  (  Chapter  Two  ).  The  tenth  differential 
equation  and  state  is  used  to  describe  the  propulsion 
dynamics. 


There  are  two  propulsion  models  -  an  rps  propulsion 
model  and  an  eta  propulsion  model.  The  rps  propulsion  model 
contains  a  first  order  differential  equation  in  terms  of  rps 


(revolutions  per  second)  and  is  the  more  accurate  model  of 
the  two  models.  The  eta  propulsion  model  contains  a  first 
order  differential  equation  in  terms  of  eta  (a  is  defined  to 
be  u/U,  where  U  is  the  actual  speed  of  the  submarine  and  u 
is  the  commanded  forward  velocity)  and  is  a  slightly 
simplified  version  of  the  rps  model.  The  importance  of  the 
eta  model  lies  in  the  fact  that  it  was  the  propulsion  model 
that  was  linearized  and  included  in  the  linear  equations  of 
motion.  These  propulsion  models  are  documented  in  another 
Draper  memo. 

The  controls  that  may  be  specified  are  bow/f airwater 
planes,  rudder,  stern  planes  (which  may  be  segmented),  and 
WSTEAM  (steam  flow). 


Section  Thrt 


Program  Description 


This  section  describes  how  the  four  main  tasks 
the  introduction  are  accomplished. 


1 isted 


Before  linearized  dynamics  can  be  calculated,  equations 
of  motion  integrated,  and/or  local  equilibrium  points 
searched  for,  the  program  must  be  read  in  and  can  print  out 
upon  request  the  mass  properties,  the  hydrodynamic 
coefficients,  and  the  propulsion  and  drag  constants.  These 
constants  and  coefficients  describe  the  dynamics  of  a 
specified  submarine,  and  with  two  exceptions,  are  assumed  to 
be  valid  for  any  dynamic  condition.  The  exceptions  are  the 
propulsion  variables  "thrded"  and  "wake".  The  rps 
propulsion  model  calculates  these  variables  and,  therefore, 
values  that  are  read  in  are  ignored.  However,  in 
ref ormul at i ng  the  rps  propulsion  model  into  the  eta 
propulsion  model,  these  two  propulsion  variables  were 
assumed  to  be  constant.  A  method  of  determining  appropriate 
values  of  these  constants  is  to  integrate  the  nonlinear 
equations  with  the  rps  propulsion  model  using  the  same 
initial  conditions  that  will  be  used  to  integrate  the 
equations  with  the  eta  model.  Then,  use  the  values  of 
"thrded"  and  "wake"  after  the  initial  transients  of  the 
states  have  "died  out".  The  program  prints  out  the  final 
values  of  "thrded"  and  "wake"  at  the  end  of  integrating  the 
nonlinear  equations  with  the  rps  model. 


The  p 
matrices  s 
main  tasks. 


program  then  proceeds  to  calculate  the  E  and  E 
as  the  E  1  matrix  is  needed  for  any  of  the  foi. 


main  tasks.  An  indication  of  the  accuracy  of  the  E  matrix 
is  obtained  by  multiplying  the  g  and  E  matrices.  The 
program  prints  each  one  of  these  matrices  (i.e.,  E,  E  ,  and 
EE  * )  . 

If  the  option  to  integrate  the  nonlinear  equations  of 
motion  was  selected,  the  initial  conditions  necessary  to 
integrate  the  equations  are  read  in.  There  is  an  option 
that  can  be  set  in  the  input  data  file  containing  the 


initial  conditions  on  p,  q,  and  r  from  initial  conditions  on 
psidot,  phidot,  and  thetadot.  Also,  the  input  data  -file 
contains  initial  conditions  for  both  the  variables  rps  and 
eta.  As  mentioned  in  section  2,  there  are  both  an  rps  and 
an  eta  propulsion  model.  If  the  rps  model  was  chosen,  the 
initial  condition  on  rps  is  used  and  eta  is  calculated.  If 
the  eta  model  was  chosen,  the  initial  condition  on  eta  is 
used  and  the  rps  initial  condition  is  ignored. 

The  program  proceeds  to  integrate  the  nonlinear 
equations  of  motion  using  a  fourth  order  Runge  Kutta 
routine.  The  values  of  the  controls  can  be  set  in  two  ways. 
They  can  be  either  initialized  and  kept  constant  at  that 
value  throughout  the  run  or  be  read  from  a  data  file. 
Another  possibility,  if  the  rps  model  is  being  used,  is  to 
calculate  the  controls  using  full  state  feedback.  For  this 
condition,  the  gain  matrix  is  read  by  the  program. 
Therefore,  it  is  necessary  for  the  program  to  read  in  the 
nominal  point  which  corresponds  to  the  linearized  model  used 
to  design  the  gain  matrix.  For  the  purposes  of  calculating 
the  controls  using  full  state  feedback  only,  eta  is 
calculated  from  rps  and  u.  It  is  subsequently  used  as  the 
tenth  state. 

When  integrating  the  nonlinear  equations  of  motion,  the 
initial  time,  the  final  time,  and  the  integration  time  step 
must  be  chosen.  In  addition,  there  are  options  to  print  the 
states  and  to  store  the  values  of  the  states  and  the 
controls  for  plotting.  The  program  writes  the  plotting  data 
using  an  unformatted  write.  A  plotting  program,  such  as 
XF'LOT 4B ,  must  be  run  to  actually  plot  the  data.  The 
frequency  of  printing  and  storing  data  for  plotting  can  be 
individually  specified  in  terms  of  time  steps. 

Also,  the  program  has  the  option  to  search  for  a  local 
equilibrium  point.  If  this  option  is  selected,  the  program 
needs  an  initial  guess  of  the  local  equilibrium  point  to 
begin  the  search.  This  initial  guess  can  be  provided  in 
either  of  two  ways.  One  way  is  to  integrate  the  nonlinear 
equations  of  motion  using  the  eta  propulsion  model.  The 
program  will  use  the  final  condition  from  integrating  the 
nonlinear  equations  as  the  guess  for  the  search  routines. 
The  other  way  is  to  read  in  an  initial  guess  in  the  same 
manner  as  reading  in  the  initial  conditions  to  integrate  the 
nonlinear  equations  of  motion. 

When  searching  for  a  local  equilibrium  point,  the 
program  uses  the  set  of  nonlinear  equations  with  the  eta 
propulsion  model.  The  reason  for  using  the  eta  propulsion 
model  is  that  the  linearized  propulsion  model  was  derived 
from  it.  Presumably,  the  reason  for  searching  for  a  local 
equilibrium  point  is  to  use  that  point  as  a  point  about 
which  to  linearize  the  nonlinear  equations  of  motion.  If 
the  vehicle  is  in  a  turn,  psidot  will  be  nonzero  and 


therefore  the  search  routines  will  be  unable  to  find  a  local 
equilibrium  point  for  this  case.  As  psi  has  no  effect  on 
the  other  differential  equations,  deleting  the  differential 
equation  in  psi  allows  a  local  equilibrium  point  (except  in 
psi)  to  be  found  when  the  vehicle  is  in  a  turn. 

To  search  for  a  local  equilibrium  point,  the  program 
uses  two  IMSL  search  routines  -  ZSPOW  and  ZSCNT.  These 
routines  take  a  supplied  initial  guess  of  the  point  and 
iterate  for  a  specified  number  of  times  before  returning  a 
point.  The  number  of  iterations  per  call  to  a  routine  must 
be  specified  by  the  user.  The  program  iterates  by 
perturbing  the  number  of  variables  specified  by  the  user 
(maximum  of  eight  are  allowed).  The  point  returned  may  or 
may  not  be  closer  to  a  local  equilibrium  point  than  the 
initial  guess.  The  closeness  of  a  point  to  being  a  local 
equilibrium  point  is  determined  by  the  sum  of  the  squares  of 
the  derivatives. 

Finally,  when  searching  for  a  local  equilibrium  point, 
there  is  one  additional  option  that  must  be  specified  -  the 
number  of  times  to  call  each  one  of  the  search  routines. 
The  program  calls  the  routines  in  the  following  manner. 
Using  the  initial  guess  supplied  by  either  input  data  or  by 
integrating  the  nonlinear  equations  with  the  eta  propulsion 
model,  the  program  calls  the  ZSPOW  routine.  After  ZSPOW 
returns  a  point,  the  program  will  cause  the  ZSPOW  routine 
again  using  the  point  returned  as  the  initial  guess.  The 
program  repeatedly  calls  the  ZSPOW  routine  unless:  (1)  the 
point  returned  is  not  closer  than  the  initial  guess,  or  (2) 
the  specified  number  of  times  to  call  the  search  routine  is 
exceeded.  Then  the  program  follows  the  same  procedure  with 
the  ZSCNT  routine  with  the  first  guess  being  the  closest  to 
a  local  equilibrium  point  available. 

If  the  option  to  calculate  the  linearized  dynamics  was 
selected,  the  program  would  read  in  the  nominal  point  about 
which  the  nonlinear  equations  are  linearized. 

If  the  option  to  integrate  the  linearized  dynamics  was 
chosen,  the  program  will  read  in  the  nominal  point  and 
calculate  the  linearized  dynamics  if  the  option  to  calculate 
the  linearized  dynamics  was  not  already  chosen  before.  The 
program  will  then  read  in  the  initial  conditions  on  the 
states  and  on  the  controls,  calculate  the  perturbati osn  from 
the  nominal  point,  and  integrate  the  linearized  equations. 
As  with  integrating  the  nonlinear  equations  of  motion,  the 
user  must  specify  the  initial  time,  final  time,  and 
integration  time  step.  Also,  the  options  to  store  data  for 
plotting,  to  print,  as  well  as  the  frequency  of  carrying  out 


each  step  are  the  same  as  in  integrating  the  nonlinear  case. 
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Hatrii  uiod  to  prtMltiply  tho  C 

•atrixi 

S.7300E+01 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

3.7300E+01 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

3.7300E+0I 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

l.OOOOE+OO 

Hatrii  umO  to  poitoultiply  tho  C 

•atrixi 

1 . OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

l.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

l.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

1 . 74S2E-02 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

1.7452E-02 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOuc'+OO 

O.OOOOE+OO 

O.OOOOE+OO 

1.74S2E-02 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

1.7452E-02 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

1.7432E-02 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

1.7452E-02 

O.OOOOE+OO 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  l.OOOOE+OO 
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APPENDIX  C3 


mtrices  used  to  perform  transfqpnat  i dns  for  control  surface  deflection 

AND  RELATIVE  WCI6HT1W6  Of  THE  OUTPUTS 


■V 


* 

v;.'. 

*  d 
■*>:-; 

&4 


l.OOOOE+OO 

O.OOOOE+OO  O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

A.A700E-01  O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO  8.0000E-01 

O.OOOOE+OO  |  J 

O.OOOOE+OO 

O.OOOOE+OO  O.OOOOE+OO 

B.OOOOE-Ol 

S'1 

u 

k»”-  /' 

l.OOOOE+OO 

O.OOOOE+OO  O.OOOOE+OO 

O.OOOOE+OO 

V  V  ' 

O.OOOOE+OO 

1 . 4993E+00  O.OOOOE+OO 

O.OOOOE+OO 

J'.  yu*  i 

O.OOOOE+OO 

O.OOOOE+OO  1.2300E+00 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO  O.OOOOE+OO 

1.2500E+00 

% 

ST 

l.OOOOE-Ol 

O.OOOOE+OO  O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

l.OOOOE-Ol  O.OOOOE+OO 

O.OOOOE+OO 

£ 

O.OOOOE+OO 

O.OOOOE+OO  l.OOOOE+OO 

O.OOOOE+OO 

••  ' 

•  * 

O.OOOOE+OO 

O.OOOOE+OO  O.OOOOE+OO 

l.OOOOE+OO 

-  •-  ■SJ 

I  1 
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APPENDIX  C4 


REDUCED  AM  SCALED  PLANT  MATRICES  WITH  APPROPNIATE  C  MATRIX 
MODEL  KITH  ROLL  CORTROL 

x^^Cuvwpqr^eJ 
A  MATRIX 

-3.8249E-02  -2.1944E-02  -2.7333E-03  -3.3173E-04  2.07J4E-03  5.5394E-02  O.OOOOE+OO  5.1285E-0A 

1.1417E-03  -1.5939E-01  -3.378AE-05  -2.3578E-02  2.83S3E-03  -2.68A0E-01  2.2745E-03  -2.5914E-05 

-4.7476E-04  1.3910E-03  -9.6526E-02  -2.7949E-02  2.1163E-01  7.6140E-04  O.OOOOE+OO  1.3221E-04 

1.3945E-02  -6.643QE-0I  -B.093IE-02  -4.3452E-01  -2.3242E-01  -2. 1920E-02  -1.6030E-01  1.8264E-03 

7.1418E-05  -2.5929E-04  7.8U7E-02  -1.1404E-02  -4.0B15E-01  -7.7327E-04  O.OOOOE+OO  -2.4983E-03 

-1.5782E-03  -1.1622E-01  3.4035E-04  -B.0011E-03  2.2809E-03  -3.B201E-01  2.5893E-04  -2.9501E-06 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  1.0000E+00  1.1328E-02  -1.0538E-01  -4.93J2E-10  -1.2433E-02 

0. OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  9.9427E-01  1.04B9E-01  1.2494E-02  O.OOOOE+OO 

uT  =  C  ib  Sr  *s2  3 

8  MATRIX 

-1.2444E-03  -1.5279E-03  9.BA23E-03  9.B425E-05 
O.OOOOE+OO  6.0491E-02  -3.4974E-03  3.6976E-03 
•2.5204E-02  -3.8743E-08  -2.1483E-02  -2.1483E-02 
O.OOOOE+OO  4.3847E-02  2.6060E-01  -2.4040E-01 
1.3873E-02  7.3254E-07  -2.97BIE-02  -2.97BIE-02 
O.OOOOE+OO  -S.7B44E-02  -4.2094E-04  4.2094E-04 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
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T  •  • 

y'  =  C  ♦  0  f  2  D 

C  MATRIX 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  l.OOOOE-Ol  O.OOOOE+OO 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  l.OOOOE-Ol 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  -1.0749E-01  9.99B4E-01  4.4827E-09  1.331EE-03 

1.0339E-01  -1.0629E-01  9.B873E-01  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  2.7119E-02  -B.4843E-01 
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T  •  * 

y  *  c  e  v  z  1 

C  MATRIX 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  I.OOOOE-Ol 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  -X.0749E-01  9.9984E-01  4.M27E-09  1.3316E-03 

1 . 0S39E-01  -1.0A29E-01  9.8873E-01  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  2.7119E-02  -8.4843E-01 


APPEND X  X  D 


MODAL  ANALYSIS  RESULTS 


The  matrices  are  presented  in  the  standard  row  and  column 
■format.  Additionally,  the  data  presented  consists  o-f  complex 
numbers.  As  such,  the  numbers  are  always  displayed  with  the 
inaginary  part  directly  below  the  real  part.  The 
eigenvectors  (modal  matrices)  are  presented  as  complex  column 
vectors. 


APPENDIX  Dt 


NODAL  ANALYSIS  FOA  0ESI8N  KITH  ROLL  CONTROL 


PLANT  EIGENVALUES 

-1.417AE-02 

•4.0M1E-02 

-4.2884E-02 

■7.1364E-02  -1.9A89E-01  -1.94B9E-01 

•4.5114E-01 

-5.048AE-01 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO  3.1300E-0I  -3.I300E-0I 

O.OOOOE+OO 

O.OOOOE+OO 

TRANSMISSION  ZEROS 

S.8JQ2E+07 

1.2014E+07 

7.B2A9E+OA 

-S.8414E-02  -2.5097E-01  -1.3AB0E+01 

•1.3579E+01 

-2.4894E+08 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO  O.OOOOE+OO  1.IA09E+04 

-1.1A09E+04 

O.OOOOE+OO 

EI8ENVECT0RS  (NODAL  NATRIll 

-6.B341E-03 

-2.3A3BE-01 

1.0305E-01 

2. S104E-01  -1.3119E-03  -1.3U9E-03 

-1.0292E-03 

1.7639E-02 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO  -1.4355E-03  1.4353E-03 

O.OOOOE+OO 

O.OOOOE+OO 

2.A727E-03 

•2.0890E-02 

2.421AE-03 

1 . 8914E-01  -1.3214E-02  -1.32IAE-02 

2.9403E-02 

-2.190IE-01 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO  -1.8009E-02  1.8009E-02 

O.OOOOE+OO 

O.OOOOE+OO 

4.0471E-02 

1.3080E-01 

1.7237E-01 

8.SI27E-02  -2.918AE-02  -2.91BAE-02 

2.141BE-01 

*4. 1687E-03 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO  -A.5275E-03  4.5275E-03 

O.OOOOE+OO 

O.OOOOE+OO 

-I.2341E-02 

-B.9444E-03 

-6.25ASE-03 

3.9A40E-02  -2.3084E-01  -2.30BAE-01 

-1.4102E-01 

-4.4041E-01 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO  2.5728E-OI  -2.3728E-01 

O.OOOOE+OO 

O.OOOOE+OO 

1.4711E-02 

3.8749E-02 

4.3A90E-02 

1.7990E-02  -A.9174E-03  -4.9174E-03 

•3.7B38E-01 

•4.7BA8E-02 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO  -3.9444E-03  3.9444E-03 

O.OOOOE+OO 

O.OOOOE+OO 

-4.54IIE-04 

8.87BAE-03 

*8. I227E-04 

-7.2442E-02  3.18S0E-03  3.1830E-03 

4.32I8E-02 

-2.3448E-01 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO  -8. 43I2E-03  B.4312E-03 

O.OOOOE+OO 

O.OOOOE+OO 

-3.4241E-02 

-4.2983E-02 

-I.5239E-01 

-9.4101E-0I  9.2397E-OI  9.2397E-Ot 

3.5497E-01 

8.271AE-01 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO  1.37A3E-0I  -I.5743E-01 

O.OOOOE+OO 

O.OOOOE+OO 

-9.9838E-01 

•9.3130E-0I 

-*9.M48E-01 

2.8480E-02  -1.8402E-02  -1.BA02E-02 

8. 1384E-01 

1.2387E-01 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO  -4.9793E-03  4.9793E-03 

O.OOOOE+OO 

O.OOOOE+OO 

1ST 
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CONTROLLABILITY  MATRIX 


5.4154E-01  1.78401*01  4.1453E-01  4.8434E-01 
-1.991 IE- 10  1.42321*09  -3. 78821-10  4.71A9E-10 

-2.83941-01  3.5042E-01  -1.2380E-01  -1.3388E-01 
-4. 2*791-10  2.707*1-09  7.3384E-10  -5.1437E-10 

-4.4133E-01  *3.23481-01  -2. 31881-01  -2. 45551-01 
8. *2421-10  -4. 1347E-09  -4.7910E-10  1.4451E-10 

-3. 13171-02  3. 72481-01  1.4873E-04  -4.3804E-02 
-1.0340E-09  4.5318E-09  7.4294E-10  -3.8432E-10 

4.2000E-02  1.3333E-01  -1.1720E-01  1.3230E-02 
1.1239E-01  -2.941BE-01  -S.9723E-01  S.7354E-01 

4.2000E-02  1.S333E-01  -1.1720E-01  1.3230E-02 
-1.1239E-01  2.941BE-01  S.9723E-0I  -S.7354E-01 

-3.9413E-01  -2.3393E-02  7.4400E-02  8.4577E-02 
3. 8132E-12  -1.3241E-10  -S.0478E-10  3.0320E-10 

-S.4283E-02  1.3913E-01  -3.4203E-02  4.2273E-02 
2.3480E-10  3.5413E-10  2.0900E-09  -2.1B48E-09 


OBSERVABILITY  MATRIX 


-3.4241E-03  -4.2983E-03  -1.5239E-02  -9.4101E-02  9.2397E-02  9.2397E-02  3.5497E-02  B.2714E-02 

0. OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  1.5743E-02  -1.5743E-02  O.OOOOE+OO  O.OOOOE+OO 

-9.9838E-02  -9.5130E-02  -9.4448E-02  2.8480E-03  -1.B402E-03  -1.8A02E-03  8.1384E-02  1.2387E-02 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  -4.9793E-04  4.9793E-04  O.OOOOE+OO  O.OOOOE+OO 

-3.3447E-03  3.4451E-03  -4.7931E-03  -7.4483E-02  5.9029E-03  S.9029E-03  B.4943E-02  -2.3U3E-01 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  -7.7973E-03  7.7975E-03  O.OOOOE+OO  O.OOOOE+OO 

B.8314E-01  9.29B4E-01  9.9710E-01  4.1243E-02  1.3249E-02  1.3249E-02  -4.7233E-01  -4.1443E-02 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  3.7872E-03  -3.7872E-03  O.OOOOE+OO  O.OOOOE+OO 


APPENDIX  02 


NODAL  ANALYSIS  FOR  OESIfiN  NITHOUT  ROLL  CONTROL 


PLANT  EISENVALUES 


-1.4174E-02  -4.0441E-02  -4.28B4E-02  -7.1344E-02  -1.9489E-01  -1.9489E-01  -4.5114E-01  -5.0484E-01 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  3. 1300E-01  -3.1300E-01  O.OOOOE+OO  O.OOOOE+OO 


TRANSMISSION  ZEROS 


3.0779E+07  3.3553E+03  -J.B432E-02  -1.8029E-01  -1.8029E-01  -3.I812E-01  -5.5541E+03  -1.3282E+08 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  3.0U4E-01  -3.0144E-01  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 


E16ENVECT0RS  (NODAL  NATRIX) 


-6.8361E-03  -2.545BE-01  I.0305E-01  2.5104E-01  -1.3119E-03  -1.31I9E-03  -1.0292E-03  1.7439E-02 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  -1.4335E-03  1.A333E-03  O.OOOOE+OO  O.OOOOE+OO 

2.4727E-03  -2.0890E-02  2.421AE-03  1.8314E-01  -I.321AE-02  -1.3214E-02  2.9403E-02  -2.1901E-01 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  -1.8009E-02  1.8009E-02  O.OOOOE+OO  O.OOOOE+OO 

4.0471E-02  1 . 3080E-01  1.7237E-01  8.3127E-02  -2.9IBAE-02  -2.9I84E-02  2.141BE-01  -4.1687E-03 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  -4.3273E-03  4.5273E-03  O.OOOOE+OO  O.OOOOE+OO 

-1.2341E-02  -B.9444E-03  -6.2363E-03  5.9440E-02  -2.30BAE-01  -2.3084E-01  -1.4102E-01  -4.404IE-0I 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  2.3728E-01  -2.5728E-01  O.OOOOE+OO  O.OOOOE+OO 

1.4711E-02  3.8749E-02  4.3A90E-02  1.73901-02  -4.9174E-03  -4.9174E-03  -3.7838E-01  -4.7B48E-02 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  -3. 9444E-03  3.9444E-03  O.OOOOE+OO  O.OOOOE+OO 

-4.34UE-04  I.87IAE-03  -8.1227E-04  -7.2A42E-02  5.1830E-03  5.1830E-03  4.3218E-02  -2.3A48E-01 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  -8.4312E-03  8.4312E-03  O.OOOOE+OO  O.OOOOE+OO 

-3.424IE-02  -4.2983E-02  -1.3239E-01  -9.4101E-0!  9.2397E-01  9.2397E-01  3.3497E-01  8.2714E-01 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  1.3743E-0I  -1.3743E-01  O.OOOOE+OO  O.OOOOE+OO 

-9.9838E-01  -9.3150E-01  -9.4448E-01  2.B480E-02  -1.8402E-02  -1.B402E-02  8.1384E-01  1.2387E-01 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  -4.9793E-03  4.9793E-03  O.OOOOE+OO  O.OOOOE+OO 
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CMTMUM1LITV  MTRIX 


3.4134E-01 

•1.W1E-10 

-2.B394E-01 

-4.2479E-10 


-5.1517E-02 

•1.0340E-09 

4.2000E— 02 
1.1239E-0I 

4.2000E-02 

-1.1239E-01 

-3.9413E-01 

3.8132E-12 

-3.42B3E-02 

2.3480E-10 


1.7840E-01 

1.4232E-09 

3.5042E-01 

2.7074C-00 


5.7248E-01 

4.531BE-09 

1.SS33E-0I 

-2.941BE-01 

1.3333E-01 
2. 941BE-01 

-2.3593E-02 

-1.3241E-10 

1.3913E-01 

3.S41SE-10 


8.2094E-01 

1.0434E-10 

-2.5325E-01 

1.7222E-10 

-4.7091E-01 

-2.I973E-10 

-4.0715E-02 

3.1755E-10 

-9.1490E-02 

5.B204E-03 

‘9.1490E-02 

-S.B204E-03 

1.4300E-01 
2. 2217E-1 1 

2.40121*02 

-1.8420E-10 


-4.4135E-01  -3.2348E-01 
I.4242E-10  -4.1347E-09 


0I8ERVABILITY  MATRIX 


■9. 9838E-02  -9.5130E-02  -9.444BE-02  2.B4B0E-03  -1.B402E-03  -1.B402E-03  8.13B4E-02 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  -4.9793E-04  4.9793E-04  O.OOOOE+OO 

■3.3447E-03  3.4451E-03  -4.7931E-03  -7.4483E-02  5.W29E-03  5.9029E-Q3  8.4945E-02 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  -7. 7973E-03  7.7973E-03  O.OOOOE+OO 


1.23B7E-02 

O.OOOOE+OO 

-2.3113E-01 

O.OOOOE+OO 


B.8314C-01  9.2984E-01  9.9710E-01  4.1243E-02  1.3249E-02  1.3249E-02  -4.7233E-01  -4.1443E-02 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  3.7872E-03  -3.7872E-03  O.OOOOE+OO  O.OOOOE+OO 


APPENDIX  E 


GAIN  MATRICES  AND  PROPERTIES  OF  THE  CLOSED  LOOP  SYSTEM 


For  the  4-input,  4-output  design  the  Kalman  -filter,  control 
gain,  and  L  matrices  are  real  matrices  displayed  as  12x4, 
4x12,  and  12x4  matrices,  respectively.  In  the  case  o-f  the 
control  gain  matrices,  the  12  elements  o-f  each  row  are 
displayed  as  two  rows,  containing  the  -first  six  elements  in 
one  row  and  the  last  six  elements  in  the  next.  The 
eigenvalues  and  transmission  zeros  of  the  open  and  closed 
loop  plant  are  1x24  complex  matrices.  The  24  elements  in 
the  row  are  displayed  as  four  rows,  with  six  elements  in 
each  row.  The  imaginary  part  of  each  element  is  directly 
below  the  real  part.  Similar  notation  is  used  for  the  3- 
input,  3-output  design. 
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PROPERTIES  OF  THE  ROLL  CONTROL  RQflEL 

FILTER  SAIN  MATRIX 

-1.02B2E+00  -1.8198E+01  -B.1019E-01  -2.I480E+00 

1 . 1923E-01  7.9327E-02  -7.5141E-01  2.B994E-02 

1.9031E+00  1.7444E+00  -B.4529E-01  1.3837E-01 

-1.4904E+00  4. 2619E-01  1.2014E+00  1.141SE-01 

9.300SE-03  4.4870E-01  9.2495E-02  5.4981E-02 

4.8777E-03  -3.47B3E-01  -2.4354E-01  -3.8983E-02 

2.4814E-02  4.1892E+00  2.U97E-01  4.9849E-01 

1.8704E-01  2.4745E-01  -3.3220E-01  4.920QE-02 

-3.Q473E-02  -4.2343E-03  -3.1907E-02  3.3337E-04 

-4.2073E-02  2.1331E-02  3.8510E-01  -4.2349E-03 

5.3431E+00  2. 1792E-OI  -3.8501E-0I  -I.3210E-01 

2. I792E-0I  4. 9887E+00  2.B424E-01  -4.B414E-03 

CONTROL  BAIN  MTRII 

1.34B7E+00  1.4722E-03  -1.8437E-03  3.2330E-03  -2.8933E+00  2.1B43E+00 

-2.30B1E+01  4.4479E-02  2.S344E+0I  2.023BE+00  -2.37B9E-01  2.5951E+OI 

1.4722E-03  2.0983E+00  -1. 1733E-02  -4.2471E-02  -4.7100E-02  2.5212E+00 

-7.4947E-01  1 . 9053E-01  1.7014E+00  -2.3194E+01  8.8982E-02  3.44SQE-01 

-1.8437E-03  -1.1733E-02  1.3132E+00  -3.5292E-01  -7.9315E-0I  -1.3192E+00 

-8.41S3E+00  2. 3982E+00  -1.9349E+00  1.4394E+00  1.4934E+00  4.8954E+00 

3.2330E-03  -4. 247 IE-02  -3.3292E-01  1.2833E+00  -9.4103E-01  2.7412E+00 

-B.7U2E+00  -2.5781E+00  -S.8331E-01  4.B044E-01  -1.9771E+00  5.4309E+00 
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L  MATRIX 


-4.0839E-01  -3.4479E+01  5.4433E-01  -4.3335E+00 
1.5410E-02  8.7U4E-02  -1.5284E+00  4.4870E-03 


3.3427E+00  3. 5527E+00  -2.4335E+00  4.4871E-01 


-2.4340E+00  B.B302E-01  2.7345E+00  1.5325E-01 
-2. B382E-02  B.9419E-01  8.1547E-14  1.0339E-01 


2.B824E-02  -9.01B2E-01  -8.2242E-14  -1.0629E-01 


-2.4814E-01  B.3888E+00  7.4502E-13  9.8873E-01 


O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 


4.9774E-09  1.4154E-03  -1.0429E-01  -4.4349E-13 


-4.4300E-06  -1 . 3144E-02  9.8873E-01  4.1272E-12 
1.0000E+01  -1 . 4491E-09  -3.B444E-17  1.24B8E-11 


-1.3284E-10  1.0000E+01  4.9211E-12  -5.5B41E-09 


OPEN  LOOP  EIGENVALUES 


9.S643E-09  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  -1.4174E-02  -3.8412E-02 

4. 4084E-01  -4.4084E-01  -4.5U4E-01  -5.04B4E-01  -5.B945E-01  -5.B945E-01 

4.0441E-02  -4.2884E-02  -7.U44E-02  -1.9489E-01  -1.94B9E-01  -2.5114E-01 

9.S148E-01  -9.5148E-01  -1.0104E+00  -1.3887E+00  -1.3887E+00  -1.4442E+00 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 

4.7901E-01  -4.7901E-01  O.OOOOE+OO  O.OOOOE+OO  1.1344E+00  -1.1344E+00 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  3.1300E-01  -3.1300E-01  O.OOOOE+OO 

1.0146E+00  -1.0148E+00  O.OOOOE+OO  1.31B4E+00  -1.31B4E+00  O.OOOOE+OO 
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OPEN  LOOP  TRANSMISSION  ZEROS 


t.OOOOE+30  1.0000E+30  1.0000E+30  1.0000E+30  1.1425E+08  1.0192E+08 

■J. 9747E-02  -3.9747E-02  -1.9849E-01  -2.0449E-01  -2.0449E-0!  -2.5097E-01 

1.2814E+05  1.4240E+04  1.21J3E+00  1.2202E+00  -1.4234E-02  -3.8414E-02 

-2.83S7E-0I  -4.3944E-0I  -1.4243E+04  -1.2B14E+03  -B.4484E+07  -5.8038E+09 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 

1.4340E-03  -1.4540E-03  O.OOOOE+OO  2.B343E-01  -2.8343E-01  O.OOOOE+OO 

O.OOOOE+OO  O.OOOOE+OO  1.08S1E+04  -1.08S1E+04  O.OOOOE+OO  O.OOOOE+OO 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 

CLOSED  LOOP  EIGENVALUES 


•1.4220E-02  -3.B414E-02  -3.B479E-02  -4.1399E-02  -1.0317E-01  -1.0317E-0I 

-S.1044E-01  -5.1044E-01  -3.1514E-01  -3.2353E-01  -3.2335E-01  -7.1313E-01 

-2.3970E-01  -2.3970E-01  -2.5104E-01  -2.7292E-01  -2.7292E-01  -4.122BE-01 

■7.4533E-01  -7.3232E-01  -7.3232E-0I  -1.0388E+00  -I.I957E+00  -I.1957E+00 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  1.04S9E-01  -1.04S9E-01 

7.0401E-02  -7.0401E-02  O.OOOOE+OO  9.2H4E-01  -9.2144E-01  O.OOOOE+OO 

3.3449E-01  -3.3449E-01  O.OOOOE+OO  2.7737E-01  -2.7737E-01  O.OOOOE+OO 

O.OOOOE+OO  8.3933E-01  -B.3953E-01  O.OOOOE+OO  1.1439E+00  -1.1439E+00 


CLOSED  LOOP  TRANSMISSION  ZEROS 


7.3203E+10  1.1330E+04  8.4830E+03  4.7422E+03  2.3300E+02  2.S300E+02 

■3.9748E-02  -3.9748E-02  -1.9849E-01  -2.0449E-01  -2.0449E-01  -2.3097E-01 

1.5900E+00  1.4499E+00  2.3444E-01  7.3507E-01  -1.4233E-02  -3.84I4E-02 

-2.8357E-01  -4.39441-01  -5.0498E+02  -4.7412E+03  -B.4823E+03  -1.1349E+04 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  4.3878E+02  -4.387BE+02 

1.4327E-03  -1.4327E-03  O.OOOOE+OO  2.B343E-01  -2.B34JE-01  O.OOOOE+OO 

2.4470E+03  -2.4470E+03  1.5450E+04  -1.5450E+04  O.OOOOE+OO  O.OOOOE+OO 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
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PROPERTIES  OF  TIE  MODEL  H1THOUT  ROLL  CONTROL 

FILTER  SAIN  MATRIX 

-1.8104E+01  -9.9739E-01  -MIB7E+00 
8.3100E-02  -7 . 5396E-01  -2.4242E-03 
1.0178E+00  2.9W9E-01  1.2935E-01 
4.484BE-01  9.4995E-02  4.6515E-02 
-3.2777E-01  -2.9704E-0I  -4.0709E-02 
4.2139E+00  1.79WE-01  4.3854E-01 
-E.271BE-02  1.1100E-01  -3.5A2SE-03 
B.5074E-03  -5.1439E-02  4.8779E-05 
2.0380E-02  3.B398E-01  5.4579E-03 
-1.9794E-D1  3.5426E-01  -5.2399E-03 
5.0090E+00  2.6332E-01  -i.tlttE-02 

CONTROL  6AIN  MATRIX 

1.3399E+00  2. 4931E-03  -4.1331E-02  -2.8349E+00  2.1877E+00  -2.2711E+01 

2.6330E-02  2.3251E+01  1.9938E+00  -2.3A64E-01  2.5708E+01 

2.4931E-03  2.0930E+00  -4.48I8E-02  -6.1695E-02  2.3273E+00  -9.11B4E-01 

8.4496E-02  1.7283E+00  -2.3191E+01  -5.5890E-02  4.A906E-01 

*4. 1531E-02  -4.4818E-02  1.1898E+00  -1.334AE+00  1.2073E+00  -1.3296E+0I 

-7.3320E-02  -2.3292E+00  1.7324E+00  -4.30B8E-01  8.1221E+00 
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L  HATRIX 


-3.4209E+01  4.15J3E-02  -4.3257E+00 
8.0193E-Q2  -1.5149E+00  5.7204E-03 
2.0417E+00  4.4520E-01  2.B338E-01 
8.9353E-01  -I.3558E-11  1.0532E-01 


-9. 011SE-01  1.3474E-11  -1.0421E-01 


8.3824E+00  -1.2719E-10  9.8801E-01 


O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 


1.41S4E-03  -1.0429E-OI  1.4458E-11 


-1.3144E-02  9.8873E-01  -1.3435E-10 
2.2992E-01  4.4272E-09  2.7099E-02 
l.OOOOE+Ol  1.1950E-11  -3.4596E-10 


OPEN  LOOP  EI6ENVALUES 


1.4791E-08  O.OOOOE+OO  O.OOOOE+OO  -1.4176E-02  -3.8430E-02  -4.0441E-02 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 

-4.2B84E-02  -7. 1344E-02  -1.8012E-01  -1.8012E-01  -1.9489E-01  -1.9689E-01 

O.OOOOE+OO  O.OOOOE+OO  3.0I58E-01  -3.0138E-01  3. 1300E-01  -J.1300E-01 

-3.1857E-01  -4.5114E-01  -4.5954E-01  -4.5954E-01  -3.0484E-01  -1.0233E+00 

O.OOOOE+OO  O.OOOOE+OO  4.9473E-01  -4.9473E-01  O.OOOOE+OO  1.1072E+00 

-1.0233E+00  -1.0443E+00  -J.3940E+00  -1.3940E+00 
•1.1072E+00  O.OOOOE+OO  1.3184E+00  -1.31B4E+00 
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OPEN  LOOP  TRANSMISSION  ZEROS 


I.0000E+30  1.0000E+30  1.0000E+30  1.7438E+U  2.3380E+10  1.2540E+08 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 

2.4318E+04  1.3204E+04  -1.4324E-02  -3.8432E-02  -3.9719E-02  -3.9719E-02 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  9.8294E-04  -9.8294E-04 

-1.5509E-01  -1.B029E-Q1  -I.8029E-OI  -1.9034E-01  -1.9034E-01  -3.1812E-01 
O.OOOOE+OO  3. 0I64E-01  -3.0164E-01  3. 1017E-01  -3.1017E-0I  O.OOOOE+OO 

-3.5414E-01  -4.S894E-01  -1.3205E+04  -2.4309E+04 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 


CLOSED  LOOP  EIGENVALUES 


-1.4259E-02  -3.8432E-02  -3.B74BE-02  -4.0957E-02  -1.3245E-01  -1.3245E-01 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  1.0424E-0I  -1.0424E-01 

-1.7991E-01  -1.799IE-01  -1.9902E-01  -1.9902E-01  -2.B854E-01  -2.B834E-01 

3.0178E-01  -3.0178E-01  3.0447E-Q1  -3.0447E-01  2.9348E-01  -2.9348E-01 

-3.1B80E-01  -4.5B48E-01  -4.84I0E-01  -5.2124E-01  -4.8742E-01  -7.5741E-01 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 

-B.4879E-01  -8.4879E-01  -1.I972E+00  -1.1972E+00 

9.4987E-01  -9. 4987E-OI  1.1434E+00  -I.I434E+00 


CLOSED  LOOP  TRANSMISSION  ZEROS 


1.0000E+30  7.5842E+08  3.0332E+04  1.3159E+04  3.1442E+02  -1.4324E-02 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 

-3.B432E-02  -3.9718E-02  -3.9718E-02  -1.5509E-0I  -1.B029E-01  -1.8029E-01 
O.OOOOE+OO  9.B524E-04  -9.B524E-04  O.OOOOE+OO  3.0144E-01  -3.0144E-01 

-1.9034E-01  -1.9034E-0I  -3.1812E-0I  -3.5414E-01  -4.5894E-0I  -2.3748E+02 
3. 1017E-01  -3. 1017E-01  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  4.4544E+02 


-2.5748E+02  -1.3144E+04  -3.0347E+04  -8.0448E+09 
-4.4344E+02  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 


